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ABSTRACT 


Steady-state  and  total  decoupling  schemes  for 
multi variable  systems  are  used  to  develop  two 
automatic  control  systems  for  the  vertical  motion  of  a 
fictitious  submarine.  A  linearized  mathematical  model 
is  derived  from  a  non-linear  model  in  six  degrees  of 
freedom.  Ecth  designs  are  simulated  and  evaluated  with 
respect  to  performance,  simplicity  of  design 
procedure,  and  grade  of  complexity.  The  controller, 
designed  via  the  steady-state  decoupling  method,  is 
implemented  in  the  non-linear  model  and  tested  under 
various  operating  conditions. 
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I. 


INTRODUCTION 


The  extreme  importance  of  automatic  control  has  become 
obvious  for  example  in  space  vehicle  control  and  missile 
guidance  where  manual  control  is  not  feasible.  In  addition 
it  can  provide  means  to  relieve  people  from  tedious  routine 
and  repetitive  manual  operations. 

The  complexity  of  a  submarine  offers  a  wide  area  of 
control  problems.  Ceep  water  and  near  surface  depth  keeping, 
maneuvering,  hovering,  fuel  economy,  safety,  crew  comfort, 
etc.  require  precise  controls. 

Characteristic  for  a  submarine  is  translation  in  three 
dimensions,  where  depth  control  is  of  essential  importance. 
The  automatic  control  of  motion  in  the  vertical  plane,  i.e. 
depth  and  pitch  control,  is  the  subject  of  this  thesis. 

Three  sets  of  planes,  the  rudder,  the  fairwater  and 
stern  plane,  the  propulsion  system,  and  a  ballast  system  can 
be  used  to  maneuver  the  submarine.  The  objective  is  to 
design  a  controller  for  depth  changing  maneuvers  by 
automatic  control  of  the  fairwater  and  stern  plane. 


Previous  designs  were  based  on  Optimal  Control  Theory, 
reguiring  feedback  of  both  position  and  rate  information. 
These  informations  are  easily  available  when  the  submarine 
is  eguipped  with  an  inertial  guidance  system.  Rate 
information  may  be  not  available,  as  for  example  in  the 
German  coastal  submarines.  It  may  also  be  a  desirable 
feature  to  have  reduced  sensor  requirements.  In  these  cases 
a  different  design  approach  must  be  used  using  position 
feedback  only. 


This  thesis  investigates  two  possible  design  methods, 
steady-state  and  total  decoupling.  As  a  basis  for  both 
designs  a  linear  model  is  developed  and  validated. 


Steady-state  decoupling  is  achieved  by  designing  a 
cascaded  diagonal  compensator  matrix,  using  classical 
sfngle-loop  techniques.  Based  on  the  desired  response 
characteristics  the  total  decoupling  scheme  leads  t-o  a 
cascaded  compensator  matrix  with  off-diagcnal  terms.  Both 
designs  are  simulated  and  evaluated  with  respect,  to 
performance,  simplicity  of  design  procedure,  and  grade  of 
complexity . 


II.   SIMULATION  MODELS 


A.   STANEARE  MODEL 


A  set  of  "  Standard  Equations  of  Motion  for  Submarine 
Simulation  "  was  developed  by  NSRDC  (Ref.  1).  Equations  and 
additional  auxiliary  equations  are  repeated  in  Appendix  A. 

These  equations  are  referred  to  a  right-hand  orthogonal 
system  cf  moving  axes,  fixed  in  the  body  with  its  origin 
located  at  the  center  of  mass  (CG)  of  the  body.  The 
x-z-plane  is  the  principle  plane  of  symmetry  (  vertical 
center  plane  fcr  submarines  );  the  x-axis  is  parallel  to  the 
baseline  cf  the  body.  Angular  velocity  components,  forces, 
and  moments  are  shewn  in  Fig.  1. 


The  equations  are  written  in  a  form  utilizing 
nondimensicnalized  hydrodynamic  coefficients  and  are 
applicable  tc  the  rigid  body  motions  of  submarines  and  other 
submerged  vehicles.  Complete  sets  of  hydrodynamic 
coefficients  have  been  determined  by  NSRDC.  The 
coefficients  for  a  fictitious  submarine  used  in  this  thesis 
stem  frcm  a  submarine  simulation  program  developed  in 
Ref.  2.  A  notation  for  the  various  terms  in  the  equations 
including  the  hydrodynamic  coefficients  is  given  in  Appendix 
B.  Numerical  values  of  coefficients  and  parameters  are  given 
in  Appendix  C.  All  coefficients  of  the  terms  containing 
(  -1)  and  DC  are  set  to  zero.  These  terms  reflect  the 
incremental  changes  in  forces  and  moments  -  generated  by 
propeller  rpa   -  due  to  either  over  or  underpropulsion .  For 


Figure  1  -   SUBMARINE  AXES 
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the  moderate  changes  in  ahead  speed  involved  in  most  normal 
maneuvers  all  terms  can  be  neglected.  The  coefficients  used 
in  this  thesis  apply  only  to  the  deeply  submerged  case,  free 
of  near-surface,  bottom,  and  wall  effects. 

As  Bef.  1  points  out,  correlation  studies  and 
preliminary  ccmparisons  have  shown  that  the  "Standard 
Equations"  together  with  a  given  set  of  coefficients  yield 
accurate  predictions  of  normal  maneuvers  in  submerged  ahead 
motion.  The  "Standard  Equations  of  Motion"  will  be  referred 
to  as  "Non-linear  Model". 

In  Hef.  2  H.L.Drurey  translated  these  equations  into 
Digital  Simulation  Language  (DSL) .  The  system  of  six 
equations  was  solved  simultaneously  by  an  approach  using 
Cramer's  rule  developed  and  programmed  by  Ref .  3.  The 
cofactors  for  the  set  of  hydrody namic  coefficients  used  in 
this  thesis  *ere  calculated  by  Drurey  and  are  used  as 
parameters.  The  validity  of  the  DSL  implementation  has  been 
shewn  by  Ref.  2. 

As  this  model  contains  non-linear  terms  it  is  not 
appropriate  fcr  the  chosen  design  approach  which  is  based  on 
the  linearity  of  the  system.  It  was  necessary  to  find  a 
linear,  representative  approximation  of  the  "Ncn- linear 
Model". 


1  1 


B.   DERIVATION  OF  THE  LINEARIZED  MODEL 


This  section  describes  the  assumptions,  procedures,   and 
tests  to  validate  the  linear  model. 


1 •   Assumptions 

*  Forward  speed  is  constant 

An  attempt  to  linearize  about  the  axial  speed,  u, 
which  affects  nearly  every  term  in  the  standard  equations, 
would  imply  a  great  deal  of  complexity.  Thus  the  forward 
speed  was  assumed  to  be  constant.  This  means  that  either  the 
forward  speed  variations  are  small  and  can  be  neglected  or 
if  variations  are  large  they  impose  a  control  problem  and 
will  be  solved  accordingly. 

*  Bell  angle  is  small 

In  submarine  maneuvering  large  roll  angles  occur 
only  in  the  form  of  "  Snap  Roll  ",  i.e.  high  speed  plus  hard 
over  rudder.  Under  normal  conditions  depth-changing  and 
-keeping  maneuvers  produce  very  small  roll  angles.  Therefore 
the  roll  angle  can  be  neglected. 

*  Cross    products  of  inertia  may  be  neglected 

Ihis  assumption  is  common  to  all  submarine 
simulations  because  the  hull  and  interior  layout  of 
submarines  is  approximately  symmetric. 
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*   All  terms  involving  W   are  neglected 

i 


This  is  possible  because  the  submarine  was  assumed 
to  be  in  triir. 

*   The  submarine  can  be  approximated  by  a  linear  model 

The  linear  equations  are  assumed  to  be  a  valid 
representation  in  the  depth- keeping  and  depth-changing  mode 
of  operation  respectively.  This  assumption  is  not  obvious 
but  will  te  verified  via  simulation. 

These   assumptions   lead   to   the  decoupling  of  the  vertical 
plane  from  the  remaining  equations. 


2«   derivation  of  state  equations 

As  this  thesis  is  only  concerned  with   the   vertical 
plane,  the  linearization  of  the  horizontal  plane  is  omitted. 

Thus  the  linear  equations  are   (FORTRAN-Notaticn,see 
Appendix  C)  : 


U  3 

^♦HDCT  -  0C*a*Q   =  L  *ZCDOT*QDOT  ♦  L  *ZWDOT*WDCT  + 

3  2 

L  *ZQD0T*UC*3  +  L  *ZW*UC*W  + 

2    2 
L  *0C  *  (ZDS*DS  ♦  ZDB*DB)        (1) 


5  a 

IY*CCOT  =  L  *HQDOT*QDOT  +  L  *MQ*UC*Q  + 

4  3 

L  *MWDOT*tfDOT  ♦  L  *MW*0C*W  + 

3    2 
L  *(JC  (MDS*DS  +  MDB*DB)   + 

E*ZE*PITCH  (2) 
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Th€  linearized  auxiliary  equations  are  : 


IFIDCT 


=  LQ 


(3) 


LZEOT 


=  W  -  UOLPITCH 


(4) 


Solving  equation  (1)  and  (2)  for  WDOT  and  LQDOT 
respectively  and  substituting  into  each  other  yields  the 
following  relations  : 


WDOT 

igDOT 

IC 


a    a    a 
11   12   13 

a    a    a 
21   22  23 

a    a    a 
31   32   33 


W 

LQ 
LPITCH 


b    b 
11   12 

b    b 
21   22 

b    b 
31   32 


DS 
DB 


(5) 


which  can  te  written  as 


Ax   ♦   3R 


where 


(6) 


1  1 


12 


13 


21 


2  1  5 

:  [L  *ZW*UC  +  L  *ZQDOT*aW*UC/ (IY-L  *MQDOT)  ]/y 

3  3  5 

:  [L  *ZQ*UC  +  K*(JC  +  L  *ZQDOT*«Q*(JC/(IZ-L  *MQDOT)  ]/g- 

4  5 

=  -[L  *ZQEOT*ZB*B/  (IY-L  *MQDOT)]/^ 

3  6  3 

:  [L  *MU*UC  +  L  *MWDOT*ZW*UC/ (M-L  *ZWDQT) ]/£ 

4  7  4 

:  [L  *MQ*UC  ♦  L  *MWDOT*ZQ*0C  ♦  L  * MWDOT*M*UC/ 


23 


(M-L  *Z*DOT)  ]/s 

■■'B*Zt/a 
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a    =  0.0 
31 

a    =  1.0 
32 

a    =0.0 
33 


2        2     7  2       5 

b    =  [L  *ZDS*UC   ♦  L  *ZQDOT*MDS*UC  /(IY-L  *MCDOT)  ]/ 

2  2     7  2       5 

b    =  [L  *ZEE*UC   ♦  L  *ZQD0T*MD3*UC  /(IY-L  *MC.DOT)  ]/ 
12 

3  2     6  2      3 

b    =  [L  *MBS*UC   +  L  *MWDOT*ZDS*UC  /(H-L  *Z«BOT)  ]/ 

3        2     6  2      3 

b    =  [L  *MEE*OC   +  L  *KWDOT*ZDB*UC  /(H-L  *ZWDOT)  ]/ 
22 

b    =  0.0 
31 

b    =0.0 
32 


with 


3  8  5 

jf»  H  -  I  *ZWDOT  -  L  *ZQDOT*MWDOT/ (IY-L  *3CDOT) 

5  8  3 

£=  IY  -  L  *MQBOT  -  L  *S  W  DOT*Z  QDOT/  ( M  -  L  *ZMDOT) 


Vector  equation  (5)  describes  the  state  variable 
representation  of  the  linearized,  vertical  plane  equations 
of  motion.  However  the  state  vector  does  not  contain  ZDOT 
but  H.  4  represents  the  component  of  u  in  the  z-direction, 
in  order  to  make  the  depth  a  state  variable  one  wants  to  use 
LZBCT  which  represents  the  depth  change  in  the  z-direction. 
Thus  the  linearized  auxiliary  equation  (4)  is  used  for  the 
transformation 

LZBCT      W  -  UC*LPITCH 
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By  definition 


A 

X  = 


LZECT 

LQ 

LFI1CH 


X  = 


I 

LPITCH 


Using   the   linear   operator  M,  the  new  set  of  state 
variables  is  formed 


a> 
x 


MX 


where 


M   = 


1 

0 

-uc 

0 

1 

0 

0 

0 

1 

equations  (6)  become 


-1*        -1* 

M   x   =   AM   x   +   5R 


then 


~  /v/     /» 


*  -1* 

x   =   MAM   x   +   MBR 


but 


thus 


Mfl   =   B   =   B 


-1 


X   =   MAM   x   +   BR 
which   can  he  rewritten  as 


X 


Ax   ♦   BR 


(7) 


16 


where 


a         [a      -DC  ]    [  a      +a       *UC  ] 
1112  13       11 

a  a  [a      *UC  +  a       ] 

21  22  21  23 

0.0  1.0  0.0 


this    can    te    written    as 


A  = 


A11*UC    A12*UC   [A13+A14*UC  ] 

2 
A21*GC    A22*0*C   [ A23*UC  +  A24  ] 

0.0       1.0  0.0 


and 


B  =  UC 


E11    B12 


E21 

C.C 


E.J 
CO 


Using  the   numerical   values   for   the   hy drcdynamic 

coefficients   given   in   Appendix  C  and  letting  UC    still  be 

variable,  the  constants  of  the  A  and  E  matrices  are 

-3 
A1 1   =  -1.728  10 

A12   =  -0.7062 


A13   =   C. 01289 


kin       =    -  1  .728  10 


-3 


A21   =   1.684  10 


-5 


A22   =  -6.365  10 


-3 


A23   =   1.884  10 


-5 


A24   =  -2.522  10 


-3 
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B11 

=    -6.666 

10 

B12 

=    -3.871 

10 

B2  1 

=    -  1.465 

10 

E22 

=       3.19C 

10 

-a 


-a 


-5 


-6 


C.   VALIDATION  OF  IINEAR  MODEL 


The  objective  of  this  section  is  to  compare  the  dynamics 
of  the  standard  model  with  the  developed  linear  model. 

In  crder  to  compare  both  models,  they  should  be  in  the 
same  initial  state,  i.e.  besides  the  identical  initial 
conditions  bcth  models  have  to  be  "  in  trim  ".  One 
linearizing  assumption  was  that  the  model  will  be  in  trim  at 
all  times.  Therefore  the  standard  model  was  brought  into 
"neutral  conditions"  for  the  given  test  speeds,  in  crder  to 
avcid  additional  forcing  terms.  This  procedure  will  be 
described  explicitly  in  a  later  chapter. 

Any  total  system  response  can  be  viewed  as  having  two 
coipcnents:  forced  and  free.  The  forced  component  includes 
the  complex  frequencies  of  the  forcing  functions,  the  free 
component  the  complex  or  natural  frequencies  of  the  system. 
Bcth  response  components  were  checked  via  simulation. 
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1*   Initial  condition  response 

It  has  expected  that  for  small  perturbations  the 
deviations  between  both  models  should  be  small.  Therefore 
initial  conditions  of  2.5°  in  pitch  where  tested  first. 
The  initial  value  of  the  second  variable  LZDOT  was  defined 
as  -UC*sin  (initial  pitch),  based  on  the  auxiliary  equation 
for  depth  change. 

Test  runs  over  400  sec  in  the  speed  range  3-15 
kncts  were  performed  simultaneously  for  both  models. 
Table  01  shows  the  max.  differences  between  the  model 
responses,  rig.  2-11  are  a  representative  selection  of  the 
depth  change  and  the  pitch  behavior.  In  each  figure  curve  1 
represents  the  non-linear,  curve  2  the  linear  model. 
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Figure  2  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =   3  KN 


21 


a 


a: 
w 

o 


as 
o 


a 


a 
a 


24.  JC 


;<io  i 


TIME  -  80  SEC  PER  INCH 

Figure  3  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =   3  KN 


22 


X 

u 

2 


— 

u 
w 
en 

H 
fa 


W 
O 
2 
< 

u 

X 

— 
Q 


■J.Ow 


24. 

1 


*3.i 


TLME    -    80    SEC    PER    INCH 

Figure    a    -       INITIAL    CONDITION    RESPONSE 
INITIAL    PITCH    =    2.5    °,    SPEED    =       7    KN 


23 


3 
9 


b 


o 

z 


a: 
w 

0- 

o 
CM 


a 


i 

o 


1 


TIME  -  80  SEC  PER  INCH 

Figure  5  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =   7  KN 


24 


X 

u 

z 


DS 

w 

0- 

w 

CO 

E- 


p 


-.: 


w 
o 

z 

< 

o 

X 
H 

Oh 

Q 


IR.Ql 


;ku?  i 


l 


KJ. 


TIME  -  80  SEC  PER  INCH 

Figure  6  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =   9  KN 


25 


— 
1/3 


0 


X 

z 


w 

PL, 
o 


o 


o 

—  r\ 


9 


1 


3  -    .  v. 


TIME  -  80  SEC  PER  INCH 

Figure  7  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =   9  KN 


26 


z 


as 
cu 

u 

- 
en 

H 


W 

z 
o 

3= 
H 

W 

Q 


3 


? 


-"  - 


KKJ 


TLME  -  80  SEC  PER  INCH 

Figure  8  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =  11  KN 


27 


a 


i 


a* 
cu 

o 
CM 


33 

U 
H 


10. 


..<10 


.  1 


TIME  -  80  SEC  PER  INCH 

Figure  9  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =  11  KN 


28 


~3 

— 


•x. 
o 

z 


w 

u 
en 

H 


w 
o 

2 

< 

pa 

u 

H 

- 

Q 


o 
o 


ci 


- 


Kid 


24.  JC 


TIME    -    80    SEC    PER    INCH 

Figure     10    -       INITIAL    CONDITION    RESPONSE 
INITIAL    PITCH    =    2.5    °,    SPEED    =     15    KN 


29 


a 


a 


O- 

Oh 

o 

CN 


3! 
O 
H 


y 


3 
O 


O 


3 
O 


-;.;: 


IU 


TIME  -  80  SEC  PER  INCH 

Figure  11  -   INITIAL  CONDITION  RESPONSE 
INITIAL  PITCH  =  2.5  °,  SPEED  =  15  KN 


30 


As  cne  can  readily  observe,  all  deviations  are  small 
for  this  initial  condition,  which  indicates  that  the 
dynamics  are  nearly  identical  for  small  perturbations. 

The  maximum  pitch  angle  expected  in  normal 
operations  is  limited  to  about  45  °.  Therefore  this  initial 
conditior  was  simulated  as  well.  As  for  the  initial 
condition  of  2.5°  the  max.  deviations  are  summarized  in 
Tatle  02.  In  Fig.  12-23  curve  1  represents  the  non-linear, 
curve  2  the  linear  model. 

The  second  set  of  initial  conditions,  which 
represents  rather  large  perturbations,  still  leads  to  very 
siailar  dynamic  behavior,  but  the  deviations  increased 
substantially.   This  was  expected  as  the  angle  appr oxidation 

sin  0  =  0 

is  rather  crude  for  angles  of  this  magnitude.  In  addition 
to  that  the  constant  speed  assumption  is  not  as  valid  as  for 
IC  =  2.5°.  For  both  sets  of  initial  condition  it  is 
observed  that  increasing  speed  tends  to  increase  the 
deviations  tetween  both  trajectories. 
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2-   I2££i^  response 

As  the  models  considered  are  deeply  submerged  and  in 
trim,  the  planes  exert  the  only  relevant  forces.  It  was 
considered  best  to  test  the  response  of  both  models 
(excluding  actuators)  to  sinusoidal  forcing  functions, 
because  in  the  controlled  system  the  rudder  excursions  due 
to  depth  and  pitch  changes  are  expected  to  be  sinusoidal. 

The  following  forcing  functions  were  chosen  for  both 
planes  separately  and  three  different  speeds  (3,  9,  15 
kncts) : 

A*sin  (3*t) 
where        A  =  35°,  15°,  5° 
and  E  =  5. 73,  2.87  °/sec 

The   magnitude   of  the  amplitude  was  limited  tc  35°, 
because  this  is  an  approximate,  mechanical  limit. 
The   max.   deviations  are  summarized  in  Table  03-05.  Curve  1 
and  2  in  Fig.  24-69  show  the  responses  of  the  non-linear  and 
linear  model  respectively. 
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Figure  34  -   FORCED  RESPONSE,  9  KH 
LDB  =  15  °SIN  . 1  t 
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Figure  35  -   FORCED  RESPONSE,  9  KN 
LDB  =  15  °SIN  . 1  t 
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Figure  36  -   FORCED  RESPONSE,  9  KN 
LDS  =   5  °SIN  . 1  t 


60 


z 


OS 

- 

o 


a 

o 


. 


1 


I 


TIME  -  80  SEC  PER  INCH 

Figure  37  -   FORCED  RESPONSE,  9  KN 
LDS  =   5  °SIN  . 1  t 
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Figure    38    -       FORCED    RESPONSE,    9    KN 
LDS    =     15    °SIN    . 1    t 
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Figure  39  -   FORCED  RESPONSE,  9  KN 
LDS  =  15  °SIN  . 1  t 
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Figure  M  -   FORCED  RESPONSE,  9  KN 
LDS  =  35  °SIN  .1  t 
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Figure  42  -   FORCED  RESPONSE,  9  KN 
LDB  =   5  °SIN  .05  t 
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Figure  U3  -   FORCED  RESPONSE,  9  KN 
LDB  =   5  °SIN  .05  t 
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Figure  44  -   FORCED  RESPONSE,  9  KN 
LDB  =  15  °SIN  .05  t 
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Figure  45  -   FORCED  RESPONSE,  9  KN 
LDB  =  15  °SIN  .05  t 


69 


X 

u 

z 


CL, 

u 

faJ 
CO 

H 

fa. 


faJ 

o 

2 
< 

X 

u 

X 
E- 

cu 

faJ 
Q 


'. 


:«.  o: 


.. 


-- 

1 


TIME    -    80    SEC    PER    INCH 

Figure    46    -      FORCED    RESPONSE,    9    KN 
LDB    =    35    °SIN    .05    t 
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Figure  43  -       FORCED  RESPONSE,  9  KN 
LDS  =   5  °SIN  .05  t 


72 


• 


«::."' 


TIME  -  80  SEC  PER  INCH 

Figure  U9  -   FORCED  RESPONSE,  9  KN 
LDS  =   5  °SIN  .05  t 
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Figure  50  -   FORCED  RESPONSE,  9  KN 
LDS  =  15  °SIN  .05  t 
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Figure  51  -   FORCED  RESPONSE,  9  KN 
LDS  =  15  °SIN  .05  t 
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Figure  52  -   FORCED  RESPONSE,  9  KN 
LDS  =  35  °SIN  .05  t 
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Figure  53  -   FORCED  RESPONSE,  9  KN 
LDS  =  35  °SIN  .05  t 
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Figure  5U  -   FORCED  RESPONSE,  15  KN 
LDB  =  35  °SIN  . 1  t 
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Pigure  55  -   PORCED  RESPONSE,  15  KN 
LDB  =  35  °SIN  .1  t 
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Figure  56  -   FORCED  RESPONSE,  15  KN 
LDB  =   5  °SIN  . 1  t 
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Figure  57  -   FORCED  RESPONSE,  15  KN 
LDB  =   5  °SIN  . 1  t 
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Figure  59  -   FORCED  RESPONSE,  15  KN 
LDB  =  15  °SIN  . 1  t 
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Figure  60  -   FORCED  RESPONSE,  15  KN 
LDB  =  35  °SIN  . 1  t 
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Figure  61  -   FORCED  RESPONSE,  15  KN 
LDB  =  35  °SIN  .1  t 
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Figure  62  -   FORCED  RESPONSE,  15  KN 
LDB  =   5  °SIN  .05  t 
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Figure  63  -   FORCED  RESPONSE,  15  KN 
LDB  =   5  °SIN  .05  t 
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Figure  64  -   FORCED  RESPONSE,  15  KN 
LDB  =  15  °SIN  .05  t 
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Figure  65  -   FORCED  RESPONSE,  15  KN 
LDB  =  15  °SIN  .05  t 
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Figure  66  -   FORCED  RESPONSE,  15  KN 
LDS  =   5  °SIN  .05  t 
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Figure  67  -   FORCED  RESPONSE,  15  KN 
LDS  =   5  °SIN  .05  t 
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Figure  68  -   FORCED  RESPONSE,  15  KN 
LDS  =  15  °SIN  .05  t 
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Figure  69  -   FORCED  RESPONSE,  15  KN 
LDS  =  15  °SIN  .05  t 
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knots 


The  response  to  the  sternplane  showed  an  increasing 
deviation  in  pitch  and  depth  change  with  increasing 
amplitude.  With  decreasing  frequency  the  gain  was 
increased.  The  percent  deviation  stayed  about  the  same. 

The  response  to  the  fairwater  plane  shows  the  same 
behavior  except  that  the  gain  ratio  DS/DB  =  3.5  for  pitch 
and  1.6  for  depth  change.  The  absolute  magnitude  of  all 
deviations  i£  considered  negligibly  small. 

This  can  ke  expected,  because  the  pitch  involved  is 
relatively  snail  and  the  speed  is  aoout  constant  (max. 
decrease  in  speed  is  .38    kn  for  35°  plane  deflection) . 

*  9  kncts 

The  speed  decreases  substantially  (up  to  2.2  kn)  for 
large  place  angles,  which  causes  bigger  deviations  in  pitch 
and  depth  change  (up  to  12.7°). 

But  it  ccuid  be  observed  that  the  linearized  model  was  still 
a  good  approximation  for  small  perturbations. 

*  15  knots 

At  this  speed  the  decrease  of  J  was  even  bigger  (up 
to  32%  at  35°  plane  deflection) ,  whicn  resulted  in  larger 
deviations  in  both  variables.  7or  small  perturbations  the 
approximation  is  still  very  good. 

Thus  it  has  been  shown  that: 

-  Approximation  by  linear  model  is  valid  for  small 
perturbations  at  all  speeds. 

-  The  dynamics  of  both  models  are  compatible. 

In    addition    it    has   been   observed,   that   the 
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linearized  acdel  is  still  valid  for  large  perturbations 
applied  ever  a  short  period  of  time  (initial  condition 
response) .  When  large  plane  angles  were  applied  over  a  long 
period,  the  speed  of  the  standard  model  decreased 
substantially,  which  made  the  constant  speed  assumption 
invalid. 


3«   Actuator  model 

The  linearized  model  does  not  include  the  dynamics 
of  the  plane  actuators,  which  are  force  and  moment 
producers.  Including  the  actuators  would  increase  the 
complexity  of  the  system.  The  actuator  dynamics  may  be 
ignored  in  the  analysis  and  initial  design  phase,  if  and 
only  if  their  dynamics  are  "  fast  "  compared  with  the  system 
dynamics . 

Frcm  our  own  experience,  we  know  that  the  response 
of  the  hydraulic  systems  to  a  unit  step  input  looks  like  an 
exponential  function  of  the  form: 


--Lt 
(  1  -  e    ) 


which  has  the  Laplace  transform  of 


1 


s     (S  +  <A) 


Thus  the  actuator  dynamics  will  be  represented  by. 


1 
(s  +  oL) 
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d.  represents  the  inverse  of  the  time  constant, 
which  has  to  be  determined.  As  the  rate  of  the  rudi-er 
deflection  depends  on  the  magnitude  of  the  desired  angle  the 
maximum  rate  limit  is  determined  by  the  mechanical  limits  of 
the  rudder,  which  are  assumed  to  be  t  35  °  for  this  model. 
It  was  assumed  that  the  maximum  deflection  is  reached  in  5 
time  constants.  As  the  needed  time  is  about  3  to  3.5  sec, 
the  time  constant  was  determined  to  be  2/3  sec. 

The  actuator  time  constant  is  fast  compared  to  those 
of  the  system.  Tnerefore  the  actuators  will  be  neglected  in 
the  design  of  the  compensators,  but  will  be  included  in  the 
simulation  of  the  compensated  system. 
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III.   DESIGN  SPECIFICATIONS 

The  objective  is  to  design  an  automatic  controller  for 
maneuvering  in  the  vertical  plane,  i.e.  depth  and  pitch 
control.  The  submarine  is  considered  deeply  submerged  and 
therefore  free  from  all  external  disturbances  like  surface-, 
bottom-,  and  wall-effects.  The  dynamics  for  a  depth  change 
include  the  depth  and  pitch  dynamics.  The  deptn  response  tc 
an  ordered  depth  change  should  basicly  look  like  a  second 
order  overdamped  or  highly  damped  system  response.  The  pitch 
shall  be  kept  as  close  as  possible  to  the  ordered  pitch, 
which  under  regular  conditions  will  be  zero.  This  submarine 
has  no  inertial  guidance  system  (as  for  example  the  German 
coastal  subirarines)  .  Rate  information  is  not  available  and 
the  only  states  to  be  used  as  feedback  are  depth,  pitch,  and 
speed.  Cue  to  this  limited  instrumentation  the  controller 
will  have  to  use  cascaded  filters. 

*   Time  requirements. 

Depth  changes  at  even  keel  for  speeds 

-  <  9  kn     10  ft  in  <  120  sec 

100  ft  in  <  240  sec 

-  >  9  kn     10  ft  in  <   60  sec 

100  ft  in  <  100  sec 
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*   Overshoot  requirements 


For  depth  changes 


<  1QC  ft      <  5  % 


>    100  ft      <  5  ft 


*        Pitch   deviations 


Always    less    than    ±    2    °    from    ordered    pitch 


*        Mechanical   constraints 


-    plane    angle    limits    according    to    diagram 
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IV.   DESIGN 


A.   TRANSPEB  FUNCTION 


The  design  approach  chosen  for  this  thesis  requir€s  the 
system  description  by  the  transfer  function  matrix.  Matrix 
equation  (7)  is  the  state  variable  representation  cf  the 
system.  The  signal  flowgrapn  equivalent  for  this  system  is 
given  below.  An  additional  integration  is  included,  because 
the  depth  is  a  desired  output. 


P5 


311 


xDOor 


zocrr 


3>B 


"Pitch 
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The  input-output  relations  of  interest  are  DEPTH/DS, 
DEETH/DB,  PITCH/DS ,  and  PITCH/DB,  because  depth  and  pitch 
will  be  the  measurable  quantities  and  will  be  used  for  the 
control. 

Applying   Mason's   gain  rule  the  input-output  relations 
have  the  form 

2 
Y(s)      N2*£   ♦  N1*s  ♦  NO 


4        3        2 
X(s)      E4*s   +  D3*s   ♦  D2*s   ♦  D1*s  ♦  DO  (8) 


The  coefficients  for  equation  (8)  are: 

ZECT/DS   : 

2 

N2  =   E 11*UC 

3 
N1  =   (A22*B1  1  -  A12*521)  *UC 

2  2  2 

NO  =   (E21*(A13  +  A14*UC  )  -  B11*(A23*UC   ♦  A24))*UC 

D4  =   1 

D3  =  -  (ill  1  ♦  A22)  *UC 

2  2  2 

D2  =   A11*A22*UC   -  (A23*UC   ♦  A24)  -  A12*A21*0C 

2  2 

D1  =   A11*(A23*0C   ♦  A24)*UC  -  A21*UC*(A13  ♦  A14*UC  ) 

DO  =   0.0 

ZDOT/DB   : 

2 

N2  =   E12*0C 

3 
N1  =  -(222*B12  -  A12*322)*UC 

2  2  2 

NO  =   (E22*(A13  +  A14*UC  )  -  312*(A23*UC   +  A24))*0C 

D4  =   1 

D3  =  -  (ill  1  ♦  A22)  *UC 
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2  2  2 

D2  =   A11*A22*UC   -  (A23*UC   +  A2U)  -  A12*A21*UC 

2  2 

D1  =   A11*(A23*0C   ♦  A24) *UC  -  A21*UC*(A13  ♦  A14*0C  ) 

DO  =   0.0 


PI1CH/DS 
N1  = 


E21*UC 


NO  =   (£2  1*31  1  -  A1  1*32  1)  *UC 

D3  =   1 

D2  =  -(111  ♦  A22) *UC 

2  2  2 

D1  =   A11*A22*UC   -  (A23*UC   +  A2U)  -  A12*A21*UC 

2  2 

DO  =   A11*(A23*UC   ♦  A2U)  *UC  -  A21*UC*(A13  ♦  A  1  4  *  UC  ) 


PI1CH/DE 
N1  = 


E22*UC 


NO  = 
D3  = 
D2  = 

D1  = 

DO  = 


(221*312  -A1  1*322) *0C 


1 


-(All  ♦  A22)*(JC 

2  2  2 

A11*A.22*UC   -  (A23*UC   +  A24)  -  A12*A21*UC 

2  2 

Al1*(A23*aC   ♦  A24)  *UC  -  A21*UC*(A13  ♦  A1U*(JC  ] 


Table  06  through  10  show  the  root-locations  for  the 
speed  range  1  Jen  -  15  kn.  The  characteristic  roots  move 
closer  to  the  origin  and  the  damping  reduces  with  decreasing 
speed.  This  indicates  that  the  overall  response  cf  the 
uncompensated  submarine  will  be  much  slower  for  3  kn  than 
for  9  kn  cr  15  kn. 
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Table  06  -  Characteristic  roots 


Speed 

Root 

Complex  roots 

1 

-2 
-0.2774  10 

-2              -1 
-0.5452  10    ±  j  0.4973  10 

2 

-2 

-0.5650  10 

-0.  1085  10    ±  j  0.484 1  10 

3 

-2 
-0.876c  10 

-0.  16  13  10    ±  j  0.4604  10 

4 

-0.1235  10 

-0.2  114  10    t    j  094245  10 

5 

-0.1705  10 

-0.2563  10    ±  j  0.3716  10 

6 

-0.2527  10 

-0.2835  10    t  j  C.2906  10 

7 

-0.4872  10 

-0.23U7  10    ±  j  0.2116  10 

3 

-0.7068  10 

-0.1933  10    ±  j  0.2032  10 

9 

-0.3812  10 

-0.1744  10    ±  j  J. 2014  10 

10 

-0.  1033 

-0. 1643  10    ±  j  0. 1999  10 

1  1 

-0. 1  186 

-0. 158o  10    ±  j  0. 1982  10 

12 

-0. 1 32  8 

-0. 1557  10    i  j  0. 1963  10 

13 

-0.  14o7 

-0. 1546  10    ±  j  0.  1940  10 

14 

-0.  1603 

-0. 1549  10    ±  j  0. 1915  10 

15 

-0. 1738 

-0. 1562  10    ±  j  0.1387  13 
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Iable  07  -  Zeros  of  ?itch/DS 


Speed 

Gain 

Boot 

1 

-4 
-0.4164   10 

-2 
-0.4370  10 

2 

-3 
-0.1674  10 

-0.8739  10 

3 

-3 

-0.37o6  10 

-0.1311  10 

i| 

-3 
-0.6675  10 

-0.1745  10 

5 

-2 
-G.  1044  10 

-0.2182  10 

6 

-0.1503  10 

-0.2619  10 

7 

-2 

-0.2047  1o 

-0.3056  10 

8 

-2 
-0.2674  10 

-0.3493  10 

9 

-2 
-0.3385  10 

-0.3929  10 

10 

-2 
-0.4179  10 

-0.4367  10 

1  1 

- 
-0.5057  10 

-0.^804  10 

12 

-2 
-0.6013  10 

-0.5236  10 

13 

_2 

-0.7058  10 

-0.5675  10 

14 

-2 
-0.6167  10 

-O.o  112  10 

15 

-2 
-C.9400  10 

-0.6549  10 
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Taole  C8  -  Zeros  of  ?itch/DB 


Speed 

Gain 

3oot 

1 

-5 
0.9  111  10 

-3 
0.9434  10 

2 

-4 
0.3o44  10 

-2 
0.1887  10 

3 

-4 
0.8200  10 

-2 

0.2831  10 

a 

-3 
0.1453  10 

-2 
0.3768  10 

5 

-3 

0.2272  10 

-2 
0.4713  10 

° 

-3 

C.3274  10 

-2 
0.5654  10 

7 

-3 

0.4457  10 

-2 

0.o599  10 

8 

-3 
0.5822  10 

-2 
0.7542  10 

9 

-3 
0.7370  10 

-2 
0.8484  10 

10 

-3 

C.9100  10 

-2 

0.9428  10 

1  1 

-2 
0. 1  10  1  10 

0. 1037  10 

12 

-2 

C.1309  10 

0. 1131  10 

13 

-2 
0.1537  10 

0. 1225  10 

14 

-2 
0.1783  10 

0.1319  10 

15 

-2 
0.2047  10 

0.1414  10 
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Table  09  -  Zeros  of  Depth/DS 


Speed 

Ga  in 

Root 

Root 

1 

-2 
-0.1904    10 

-2                                     -1 
-0.7732    10         ±    j    0.5083    10 

2 

-2 
-0.7618     10 

-1                                       -  1 

-0.  1546     10         ±    j    0.4378     10 

3 

-0.1714     10 

-1                                       -  1 

-0.2320     10         ±    j    0.2841     10 

4 

-0.3036    10 

-1 

0.5803     10 

-2 
-0.3740     10 

5 

-0.4749     10 

-1 

0.9089     10 

-0. 1366     10 

6 

-0.6643    10 

0.1183 

-0.2557     10 

7 

-0.9316     10 

0.  1438 

-0.3567     10 

8 

-0. 1217 

0. 1685 

1 

-0.4469     10 

S 

-C.1541 

0. 1926 

-0.5356     10 

10 

-C. 1S02 

1 
0.2165              -0.6190     10 

1 1 

-0.2302 

0.2400 

-0.7001     10 

12               -C.2737 

0.2633               -0.7790     10 

! 

13 

-C.3213 

0.2866 

-0.6572    10 

14 

-0.3726 

0.3097 

-0.9343     10 

15 

-094278 

0.3329 

-0.  101  1 
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Table  10  -  Zeros  of  Depth/DB 


Speed 

Sain 

Root 

Root 

1 

-2 
-0.1106    10 

-1                                       -1 

-0.  1030     10         ±    j    0.4792    10 

2 

-2 

-0.4422    10 

-1                                       -1 

-0.2059     10         ±    j    0.4404    10 

3 

-2 
-0.995C    10 

-1                                       -1 

-0.3089    10         ±    j    0.3665    10 

4 

-0.1764     10 

-1                                      -1 
-0.4  112    10         ±    j    0  .2269    10 

5 

-0.2757    10 

-1 

-0.7499     10 

-1 

-0.2784     10 

6 

-0.3972     10 

-0.  1049 

-1 
-0.1853     10 

7 

-0.54C8     10 

-0.1304 

-1 

-0.1359     10 

8 

-0.7C65     10               -0.1544 

-1 
-0.1020     10 

9 

-0.6944    10 

-0.  1775 

-0.7620     10 

10 

-C.  1  104 

-0.2003 

-2 
-0.5510     10 

1  1 

-0.  1336 

-0.2227 

-2 
-3.3713    10 

12 

-C. 1539 

-0. 2447 

-2 

-0.2156     10 

13 

-0.  1865 

-0.2o67 

-3 
-0.7430     10 

14 

-0.2  163 

-0.2886 

-3 
0.5368     10 

15 

-C. 2484 

-0.3083 

-3 

0.1734     10 
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B.   STEADY-STATE  DECOUPLING 


The  derived  model  represents  a  linear,  mul tivariable 
system.  In  crder  to  allow  the  application  of  existing 
single-locp  techniques,  such  as  Nyquist-Bode-Nicaol ' s 
methods  and  Root-Locus  design,  the  equations  must  be 
decoupled.  Decoupling  requires  the  system  to  be 
characterized  by  a  non- sing ular ,  diagonal  transfer  function 
matrix.  When  linear  state  variable  feedback  is  applied,  one 
necessary  condition  according  to  wolovich  (Hef.  12)  is  that 
a  system  characterized  by  a  (n  *  m)  transfer  function  matrix 
may  not  have  poles  at  the  origin.  The  developed  linear 
system  contains  two  transfer  functions  with  such  poles. 

Ref.  4  develops  another  approach  which  decouples  tne 
steady-state  only.  This  approach  uses  classical  cascade 
compensation  and  allows  the  precluded  poles  at  the  origin. 
Actually,  these  poles  are  used  ror  the  decoupling  of  linear, 
multivariate  systems. 

A  steady-state  decoupled  system  is  a  system  in  which 
changes  in  each  input  are  reflected  in  a  corresponding 
output  and  only  that  output,  when  steady-state  is  reached. 
Thus  mutual  interactions  are  allowed  during  the  transient 
period,  tut  only  during  this  period. 


Using  cascade  compensation  and   a   diagonal   compensator 

matrix 

"g      0 
d  1 

G   = 
c 

0      g 

c22 
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the  model  cc cf igur ation  becomes: 


~PLRNT 

oaoentD  , 

> 

9cii 

j)£PTH 

3>ei»TH 

ORDERED 

9c22 

Tircw 

TITch 

r 

where 


J     g 

p11    p12 


g    g 

p21    p22 


By  theorem  2.2  of  Hef.   a   the   system   is   steady-stare 
decoupled  if  and  only  if 


(k-1) 
1.   lim   1/  s       *  (I  +  G  G  )   /det  (I  +  G  G  ) 
■$_*°  p  c  1 2         p  c 


=  0 


(9) 


and 


2.   lim   1/  s       *  (I  +  G  G  )   /det  (I  +  G  G  )  =  0 
s-*o  p  c  2 1         p  c 


(10) 
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Since 


G  G   = 
P  C 


g   g     g   g 

p11  c11     pi  2  c22 


g   g     g   g 

p21  c11     p22  c22 


we  have 


det  (I+G  G  ) 

F  c 


=  1+g 


p  1  1  d  1   p22  c22 


g   g   g   g   ■ 

p 11  p22  c1 1  c22 

g   g  9      9 

p12  p21  c11  c22 


(11) 


and  cofactors 


(I  +  G  G  ) 
p  c  12 

(I+G  G  ) 
p  c  2 1 


9   g 

p21  c11 

g    a 
p12'c22 


(12) 
(13) 


K  and  k   are  defined  according  to 
1       2 

(input  (t))  =  1/  s 
j 

where   the    inputs   are      constants,       steps, 

arbitrary    amplitude. 


ramps   etc.,   with 


By  substituting  (11)/  (12),  and  (13)  into  (9)  and 
(10), and  assuming  a  step  input  for  depth  and  constant  pitch, 
we  have  the  two  necessary  and  sufficient  conditions  for 
steady-state  decoupling  : 


1. 


lim  g    g 
J-°   p21  c11 


/  D  =  0 


2.   lim  s*q   q    /  D  =  0 
*-°     12  22 


(14) 
(15) 
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where 


D    =    det     (I  +  G    G    ) 

F    C 


All    g      are      known.      Thus      the      design      fcr      steady-state 
F 

decoupling      is      the    determination    of    g  and   g  such    that 

d  1       c22 

(14)  and  (15)  are  satisfied. 

Although  the  locations  of  the  poles  and  zercs  are 
dependent  on  the  speed  their  number  is  independent. 
Therefore  the  poles  will  oe  called 


p       ■  »  1,2,3.  .. 
i  jm 

and  the  zeros 


z       m=  1,2,3... 
i  jm 

th 
where   ij   denotes   the   element  of  the  matrix  and  m  the  m 

fole  and  zerc  of  the  element. 

g    =  k    (s+z   )  (s  +  z   )  /  s  v- 
pi  1     11      111       112      5 


g    =  k    (s  +  z    )  (s  +  z   )  /  sf 
p12     12      121       122      6 


g    =  k    (s+z   )  / jr- 
p21     21      211  '• 


p22     *z      221    l 


1  11 


where 


r  =    (s+P    )  (s  +  p    )  (s  +  p    ) 
5       v    111       112       113 


When  these  transfer  functions  are  substituted  into 
equations  ( 1U)  and  (15),  both  limits  go  to  zero  for  ill 
speeds. 

Thus  conditions  (1)  and  (2)  are  satisfied  for  the  specified 
inputs. 

1«   £es_ign  of  closed^J-OOD  system 

The  previous  section  resulted  in  the  decoupling  of 
th€  steady-state  of  the  system.  However,  one  must  realize, 
that: 

1.  the  result  does  not  guarantee  stability. 

2.  steady-state  decoupling  is  only  meaningf ul, when 
the  closed-loop  system  is  stable. 

Thus  it  is  necessary  to  consider  the  stability  of  the 
clcsed-locp  system  after  the  steady-state  decoupling  has 
been  achieved. 

Ref.4  investigates  a  connection  between  single-loop 
and  muitivariabie  systems  by  properly  factorizing  the 
closed-lccp  cnaracteristic  equation.  It  allows  the  design  of 
muitivariabie  systems  by  using  any  suitable  single-loop 
method.  The  primary  method  chosen  will  be  the  roct-locus 
design. 
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2.   Stability  criterion 


Hef.13    and   14   prove   that   the  stability  of  tnis 
multivar iable  system  is  determined   by  the   zeros   of   N  (s) 

and  N  (s) ,  where 
2 


and 


N  (s)/D  (s)  =    det(I  ♦  G  (S)*G  (S))  (16) 

11  p     c 


N  (s)  =  A  C(S)  *Ap(s)/D  (s)  (17) 

2  1 


N  (s)/D  (s)  is  in  irreducible  form,  i.e.   all  common  factors 
1      1 

are   cancelled.    A c  (s)    represents    the    characteristic 

polynomial   cf  the  transfer  function  matrix  G  (s)  and  Ap(s) 

c 

represents  the  polynomial  of  the   transfer   function   matrix 

G  (s) .    The    characteristic   polynomial   c:   the   transfer 

P 

function    is    defined   as    the    least    common    denominator      cf      all 
miners. 


However    Ref.4      devises      a      method      by      which      it      is 
necessary    tc    check    equation     (16)     alone    for    stability,     if: 

1.      cancellations      are      selected      systematically      by 
using   equaticn     (4.5)     Ref.    4. 


2.         poles    of   G      are    carefully    selected,       which      can 

c 

be  taken  care  of  in  the  process  of  the  design. 
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Thus 


det  (i  ♦  g  g  )   =  0 

P  c 


(18) 


represents  tte  characteristic  equation  of  the   mult ivariable 
system. 


Fcr  the  system   under   consideration   equation   (13) 


becomes: 


det  (I  ♦  G  G  )  -  Ug        g    ♦  9   g     ♦  det(G  )g    g 

p  c        p11  c11     pz2  c22         p   c1  1  c22 


which  car  be  factored 


d€t(I  ♦  G  G  )  «  (1  ♦  g   g   )  (1  ♦  G   g   ) 

p  c  p  1  1  d  1        eq  c22 


where 


G    »  g    (1  ♦  detG  *g    /g    )/(1*g    g   )         (19) 
eq     p22  p   cl  1   p22       ?1  1  d  1 


Ey   cancellation   of   the   common  roots  the  equation 
determining  the  stability  of  the  system  becomes 


1  ♦  G   g     =  0 
eq  c22 


(20) 


Equation  (20)  still  contains  both  g     and   g      as 

c 1 1  c22 


unknown    functions.    It    is    possible    for    example    to   choose    g 


c11 


arbitrarily.  In  this   case   the   only   unknown   left   to   be 

designed   is   g    ,   which   means  the  design  is  reduced  to  a 

c22 

sirgle-lccp  case.  But  if  g     has  not  been  chosen   properly, 

c  1  1 

G    may   become   very  unstable.  This  can  make  the  design  of 
eq 
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g  very      difficult.      Thus      it      is      preferable        to        have 

c22 

guidelines      in      choosing      g  in    order    to    get    a   reasonable 

c  1  1 

pole-zero  pattern  for  G   ,  which  will   make   the   design   of 

eq 

q  much    easier. 

c22 


3«      Resign    Guidelines 

The      roots      of      equation       (19)     are    determined    ty   the 
following    expressions: 


1-       8      -      g  ♦    det  (G    )g 

^  p22  p      d  1 


2.      G      =       1    ♦    g        g 

1  p11    d 1 


where 


G  =      G    /G 

eq  1       2 


(21) 


Then 


det (I+GG)=G      ♦Gg 

F    c  1  2    c22 


As      the    design    is    concerned    with    the    poles    and    zeros 

of   G        they      must      be      identified.      Thev      can      be      found      by 
eq 

considering      the      functions    G      and   G    .    From    equation    (21)     it 

1  2 

can  be  seen,  that  the  zeros  of  G    are  determined  bv: 

eq 


Geq 


=  V 


+   P 

G 1     G2 


(P    f\    P   ) 

G2     G1 


(22) 
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F      =  Z    +  P    -  (P    ^  ?   ) 
Geq      G2     G1      G2  G1 


(23) 


Poles   and   zeros  of  G   and  G   are  dependent  on  the  function 

1       2 

q    according  to: 
c11 


1  ♦  d€t(G  )*g   /  g    =  0 
p    c  1 1    p22 


(24) 


1  ♦  c   g    =0 
pi  1  c11 


(25) 


Therefore  the  design  will  proceed  as  follows 


1.   Design  g     to  achieve  a   reasonable   pole-zero   pattern 
c  1 1 

for  G 

eg 

a.)  Prepare  root-locus  studies  for   equation   (24)   and 

(25).   where   g     =  f(K  ,s).   K    is   a  real  parameter 

C11  1  i 

positive    cr    negative.    The    pcles    and    zeros   of      g  are 

cl  1 

determined  by 

aa.)  number  of  free  integrators  needed  to  decouple 
the  system. 

at.)  the  needs  of  compensation,  which   may   arise, 
due  to  desired  root  locations. 


b.)  Frcir   root-locus  studies  choose  the   parameter   K  , 

1 

which   fixes  g    .  This  will  be  an  iterative  process  as 
d  1 

both  rcct-lccus  studies  in  combination   with   equations 
(22)   and  (23)  determine  the  final  pole-zero  pattern  of 


*q 
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2.   Design     cf 


c22 


in    order    to   meet   the   system 


specification.  As  G    is  known  equation  (20),  i.e. 

eq 


1  +  G   g     =  0 
eq  c22 


can  be  studied  via  root-locus,   where   g     =  f (K  , s) .    The 

c22  2 

criteria      which      determine    f (K    ,s)    are    the    same   as    mentioned 

2 

above    for    f (K    ,s)  . 
1 


3.  With  the  proper  choice  of  K 

a.)  system   stability  is  guaranteed. 

b.)  the  dynamics  of  tae  system  are  fixed. 

c.)  the  diagonal  compensator  is  determined. 

4.  The   design   is  completed.  Now  simulation  is  required  to 

check  whether  the  design  specifications  have   been   met.   If 

the   specifications   have   not   been   met,   a   redesign   of 

compensator  g     or  even  g     may  be  necessary.    But   every 
c22  c11 

trial  provides  some  insight  and  helps  with  the  next  trial. 


4.   loot^iocus  design 

Following  the  design  guide  lines  the  first  step  is  a 

roct-locus  study  for  the  equations  (24)  and  (25) .   As   shown 

in   II. B   no  free  integrators  for  g     and  g    are  required 

c11       c22 

for  the  specified  inputs. 

The   speed  range  of  interest  extends  from  3  kn  to  15 


1  17 


kn.  As  the  root  locations  of  the  system  change  with  varying 
speed,  it  is  not  certain  whether  one  compensator  set  will 
cover  the  whcle  speed  range.  It  seems  reasonable  to  design 
for  the  medium  speed  of  9  kn.  Afterwards  it  can  be  tested 
whether  this  compensator  set  is  adequate  for  the  whcle  speed 
range  and  whether  the  variations  due  to  speed  can  be  taken 
care  of  by  either  gain  variations  or  other  means.  It  may 
turn  out  that  different  compensators  are  required  tc  meet 
the  design  specifications. 


a.)  Design  of  g 


cl  1 


The    icct-lcci    for      1  +  g         g        =0      where      g         =K        are 

cl  1  p1  1  c  1  1   1 

shewn  in  Fig.  70   K   =  negative  and  Fig.  71   K    =  oositive. 

1  21 

K   =  positive  is  clearly  undesirable,  because  there  will   be 

one  branch  that  extends  along  the  positive  real  axis  tc  ♦ 

and  will  produce  a  pole  on  the  positive  real  axis  for  G 

eg 


The   root-loci   for   1   ♦   det  (G  )  *g   /q  =0  are 

p    c11   p22 

shewn  in  Fig.  72   K  =  negative  and  Fig.  73   K    =   positive. 

1  1 

For  the  same  reason  as  aDove  K   has  to  be  negative. 


From  the  root-loci  for  X   =  negative  it   is   obvious 

1 

that      further      compensation      is      needed      in    order   to   achieve 

reasonable    root    locations.       The      following      compensator      was 
chesen 


2  2 

g         =  K     (s    ♦    0.4)    /(s    ♦    4.0) 
c  1 1       1 
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.1    UNITS     PER    INCH 


Figure    70    -       ROOT    LOCOS    1+GP11*GC11 
SPEED    =    9    KN,     K1     =    NEC 


=    0 
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n 


i 


1  UNITS  PER  INCH 


Figure  71  -   ROOT  LOCOS  1+G?11*GC11 

SPEED  =  9  KN,  K1  =  POS. 


=  0 
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Figure    72    - 


ROOT    LOCUS     1  +  DET (GP) /GP22*GC1  1 
SPEED    =    9    KN,     K1    =    NEG. 


=     0 


121 
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1    UNITS     PER    INCH 


Figure  73   - 


ROOT    LOCUS     UDET(GP)/GP22*GC11 

SPEED    =    9     KNf     K1     =    POS. 


=    0 


122 


This    compensation    resulted    in    Fig.  7U     for 

1*c    g     =0  and  Fig.  75    for  1+det  (G  )g    g     =0.   The 
"c11  p11  p   c11  p11 

rocts   of   Fig.  74     represent  part  of  the  poles  of  G   -By 

eg 

means  of  the  compensation  all  roots  *ere  constrained  tc   the 

stable  region.  The  roots  of  Fig.  75    will  fcrm  the  zeros  of 

G   .  Although  this  compensation  did  not   pull   the   unstable 
eg 

branches   considerably   to   the  left  half  plane,  it  does  not 


mean  that  the  system  will  not  be  well  behaved,  because  the 
system  tehavior  will  in  the  end  be  determined  by  the  poles 
of  G   and  g 


eg 


c22 


As   Bef.  4  in  eguations  (o-33)  points  out,  the  poles 

and  zeros  cf  G    are  determined  as  follows: 
eg 


Poles:  P  =  Z   +  ?   -(?   ^  P   ) 
Geg     Gl   G2    G2    G1 

Zeros:  Z  =  Z   +  F   -  (P   n  P   ) 
Geg     G2      G^         G2    G1 


P    =  p      ♦  p 
G1      gp  1  1     gc11 


Z  =    {icots    from    foot-locus    1+g        g         =0} 

G1  pi  1    c11 


*  =    P  +P(detG    )g         -(P  AP(detG    )g         ) 

G*  gp22  p      c1  1         gp22  p      d  1 


P   „      P  =      P        for    this    system. 

G2        G1  G1 
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.1    UNITS     PER    INCH 


Figure    7U    -       ROOT    LOCUS    1+GP11*GC11    =    0 

SPEED    =    9    KN,     K1     =    NEC f     COMPENSATED 
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Figure  75  - 

SPEED  i 


ROOT  LOCOS  1+DET (GP) /GP22*GC1 1 
9  KN,  K1  =  NEC,  COMPENSATED 


=  0 
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Thus    the    fcles    of    G        are: 

eq 


p  =    P  -{0.0}+     {roots    from    root-locus    1  +  g        g         =0} 

Geg  gp1 1  p 1 1    d 1 


and    the    zeros    of    G         are: 

eq 


Z     =  {toots  from  root-locus  1+detG  g    /g    =0} 
Geq  p  d  1   p22 


G     has   four   known  poles,  namely  the  Doles  cf  the 

system  transfer  function   g    .    The   remaining   poles   and 

p11 

zeros   have  to  be  determined  from  the  compensated  roct-locus 
studies  Pig.  74   and  Fig.  75  . 


Tc  get  an  idea  how  the  pole-zero  pattern  of  G    will 

eq 

behave   with    varying    K      both    root-loci      are      superimpose!      in 

Fig.    76  I  he      additional      poles    of    g  -     {0.0}     are    added. 

p11 

They  are  independent  of  K   and  therefore  fixed. 


b.)  Design  of  g 

c22 


As  the  gain  K   is  important  for  the  magnitude  cf  the 

plane  deflection  cf  the  fairwater  planes  the  problem  is  not 
only  to  find  adequate  root  locations,  but  also  to  pick  the 
right   gain.   Two   different   gains  for  K   were  chosen  which 

determine  two  different  sets  of  pole  and  zerc  locations   for 

G   ,  thus  the  choice  of  K   fixes  the  dynamics  of  the 
eg  1 
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Figure    76    -       SUPERPOSITION    OF    FIG.    74       AND    FIG.     75 
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open-loop    system    G   .   The   closed-loop   poles   are   now 

eq 

determined  by  the  root-locus  study  for  1+G   g     =0.   Where 

eq  c22 

q    =  K  .  The  gain- compensated  studies  for  K   =  1.48  and  K 
c22     2  1  1 

=  75.0  are  shown  in  Fig.  77  and  Pig.  78  .  Fig.  77  has 
complex  roots  clcse  to  the  imaginary  axis  which  go  to  <*> 
asymptotically,  wnich  is  not  desirable  as  the  damping  gets 
too  small.  Fig.  78  shows  very  similar  behavior.  Therefore 
it  is  desired  to  move  the  asymptotes  to  the  left,  which  is 
achieved  by 


g    =K  (s+0.5)/(s+10.0)  . 
c22   2 

The   results   of   this  compensation  are  shown  in  Fig.  79  and 

Fig.  80.   for  K   =  1 .  48  and  K   =  75.0  respectively.   As   the 

compensated   root-locus  for  K   =  1.48  indicates,  G    will  be 

1  eg 

stable  for  all  values  of  K  *K   .  The   roct-lccus   for   R    = 

2   eq  1 

75.0   has   zeros   in  the  right  half  plane  and  will  limit  the 

value  of  K  *K    in  order  to  maintain  stability. 
2   eg 


As  many  poles  are  clustered  around  the  origin,  it  is 
difficult  to  tell  which  roots  will  be  dominant.  A  time 
response  could  reveal  the  dominant  roots,  but  as  the  system 
has  to  be  simulated  in  order  to  check  the  compensation 
anyhow,  because  both  outputs  have  to  satisfy  the  design 
specifications,  it  seems  more  reasonable  to  simulate  the 
total  system.  From  the  simulation  results  it  will  be  judged 
whether  the  compensation  was  sufficient  or  if  further 
compensation  is  necessary. 
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Figure  77  -   ROOT  LOCOS  1+G(ZQ)*GC22 
SPEED  =  9  KN,  K1  =  1.48 
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Figure  78  -   ROOT  LOCOS  1 +G  (EQ)  *GC22 
SPEED  =  9  KN,  K1  =  75. 
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1  UNITS  PER  INCH 


Figure  79  -   ROOT  LOCOS  1  *G  (EQ)  *GC22  =  0 
SPEED  =  9  KN,  K1  =  1.*8,  COMPENSATED 
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Figure  80  -   ROOT  LOCUS  1+G(EQ)*GC22  =  0 
SPEED  =  9  KH,  K1  =  75.  ,  COMPENSATED 


132 


5.   Simulation  of  compensated  linear  model 


a.   Eetermination  of  gain  constants 

As  mentioned  above  the  roots  of  G    will  always   be   stable 

eq 

if   a   value   of   K   =  1.46   is   chosen.  Thus  this  value  was 

1 

picked  for  tbe  initial  simulation  trials.  The  root-locus  for 

G    for   this   choice  of  K   is  shown  in  Fig.  79  .   The  next 
eg  1 

step  is  to  find  the  gain  constant  K  .   The   gains   shown   in 

2 

Fig.    79         represent      K   *K  In    order    to    determine    K    ,    K 

2      eq  2         eq 

has    to   be    found. 


Because 


G  =    g        *det(G    )  *g        /1+g        g 

eg  p22  p         c22  p 1  1    c11 


-2  7  9 

=     (-.3385     10       )   (s    ♦...)/ (s    +. . 


K  =    -.3385     10 

eq 


-2 


Therefore 


K  =     (gain    from    root-locus) /K 

2  eg 


The      only      roots      which   change    significantly    with    increasing 
gain   are    those   which    go    to  <*>    .    A      reasonable      value      for      K 
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seems  to  be  K   =  60,  because  : 
2 


-  K   is  not  too  large  (to  avoid  excessive  rudder 
2 


deflections) 

-  damping  is  greatest  in  this  region. 

Six  siiulaticn  runs  were  performed  using  the  chosen  values 
as  pointed  out  above  and   variatons   of   them.   The   ordered 
depth  change  is  10  ft.,  the  ordered  pitch  is  0  °. 
The  results  are  shewn  in  Table  11. 
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Figure  81  -   RON  1 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  82  -   RUN  2 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  83  -   RON  3 

10  FT  DEPTH  CHANGE,  9  KN 
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Figure  84  -   RUN  6 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  85  -   RUN  6 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  36  -   RUN  6 
10  FT  DEPTH  CHANGE,  9  KN 
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All  these  test  runs  showed  that  the   compensated   system   is 

stable   as   expected   and  that  the  steady-states  are  reached 

independently  without  error.  The  plane  angles  increase   with 

increasing   gains.  The  pitch  behavior  has  basically  the  same 

form  for  all   runs.   In   the   initial   phase   the   submarine 

pitches   in   the   direction   of   the   depth  change,  which  is 

counteracted  by  the  stern  planes.  Before  the   ordered   depth 

is   reached   the  submarine  pitches  in  the  opposite  direction 

and  reaches  steady-state  in  a  sinusoidally  damped  moticn.  An 

increase  in  K   reduces  the  amplitude  of  the  pitch. 
2 

The  primary  task  of  the  stern  planes  is  to 
maintain  the  ordered  pitch,  i.e.  in  this  case  even  keel,  and 
to  counteract  the  moments  generated  by  the  fairwater  planes. 
As  the  lever  arm  of  the  stern  planes  is  greater  than  the  one 
of  the  fairwater  planes,  the  stern  plane  deflections  are 
significantly  smaller. 

The  fairwater  plane  angles  exceed  the  design 
specifications   in   run  4  and  5,  which  eliminates  tnose  runs 

frcm  further  considerations  and   shows   that   K    should   be 

1 

smaller  than  2.0. 


Run  1  : 


K   =  1  . 
1 


K   =  15. 
2 


The  ordered  depth  was  reached  with  very  small  overshoot,  but 
the  system  showed  a  big  undershoot  of  10.8^  after  the  first 
peak.  This  is  due  to  the  fact  that  at  the  time  the  ordered 
depth  is  reached,  the  pitcn  is  greatest  in  the  positive 
direction.  This  is  not  desirable. 
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Run  2  : 


K   =1.5     K   =  15. 
1  2 

The   inci€as€   in   K    leads  to  an  increase  in  the  fairwater 

1 

plane    deflection.       The    depth    change    is    accelerated      and      the 

pitch      deviations      increase,       which    in    turn    leads    tc    greater 

stern    plane    deflections.    The    amplitudes   of    the      oscillations 

increase,      the      overshoot      reaches      11.4%    and   the    undershoot 

11.4%.    As      the      fairwater      planes      have      reached      about      the 

allowed      deflection      limits      K         will      not      be    increased    anv 

1 

further.    The    action    taken    will    concern    K      onlv. 

2 


Run    3 


K      =1.5  K       =    40. 

1  2 


K    resulted   in   larger   stern   plane 
2 


The    increase    in 

deflections,  which  damped  the  pitch  more  than  before.  Due  to 


the  smaller  pitch  changes  wnich  at  the  same  time  support  the 
depth  response,  the  deviations  are  decreased  significantly 
and  die  out  rapidly.  The  trade-off  which  has  to  be 
considered  is  that  increasing  the  damping  will  result  in 
longer  tiies  until  the  ordered  depth  is  reached. 

Run  4  and  5  : 

are  not  considered  as  mentioned  above. 
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Run  6  : 


K   =  1  .5     K   =  60. 
1  2 

This   further   increase   in   K    confirmed   the    previously 

2 

observed   tendency.   The  overshoot  is  decreased  to  3.6  %   and 

there  is  essentially  no  undershoot.  Both  run  3  and  6  satisfy 
the  design  specifications.  But  run  6  shows  clearly  the  more 
desirable  behavior  as  the  pitch  is  smaller,  the  overshoot  is 
less  and  the  depth  accuracy  is  more  important  than  the  small 
sacrifice  in  time,  as  all  these  depth  maneuvers  represent 
standard  depth  changes  and  no  emergency  dives. 


b.   Check  for  valid  speed  range 

So  far  the  compensator  is  designed  for  9  kn.  The 
sensitivity  cf  the  compensated  system  to  speed  is  important 
for  two  reasons.  First,  the  constant  speed  assumption  for 
the  linear  model  is  not  quite  accurate,  because  on  our 
submarines  the  speed  is  ordered  in  form  of  rpm.  The  actual 
speed  varies  with  rudder  deflections  and  pitch  angle.  These 
influences  result  in  small  speed  changes.  This  phenomenon 
was  observed  in  the  comparative  test  runs  with  the  linear 
and  non-linear  models.  Second,  it  is  of  interest  to  find  the 
speed  range  where  this  compensator  still  yields  a 
satisfactory  behavior  which  is  within  the  design 
specifications. 

Therefore  simulation  runs  with  the  compensator 
designed  for  9  kn  were  performed  for  the  speed  range  from  3 
kn  to  15  kn  at  2  kn-intervals.  The  results  are  shewn  in 
Table  12. 
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Figure  87  -   RUN  1 
100  FT  DEPTH  CHANGE,  3  KN 
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Figure  88  -   RUN  2 
100  FT  DEPTH  CHANGE,  5  KN 
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Figure  89  -   RUN  3 
100  FT  DEPTH  CHANGE,  7  KN 
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Figure  90  -   RUN  5 
100  FT  DEPTH  CHANGE,  11  KN 
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Figure  91  -   RON  6 
100  ?T  DEPTH  CHANGE,  13  KN 
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Figure  92  -   RUN  7 
100  FT  DEPTH  CHANGE,  15  KN 
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As  can  be  seen  frcm  Table  06  the  poles  of  the  characteristic 
equation  of  the  open  loop  system  transfer  functions  move 
closer  tc  the  origin  of  the  s-plane  with  decreasing  speeed, 
which  should  lead  to  a  slower  response.  At  the  same  time  the 
damping- ratio  decreases  with  decreasing  speed.  All  test  runs 
reflect  this  observed  tendency. 

*    Run  4-7  : 

The  time,  at  which  the  ordered  depth  was  reached  for  the 
first  tine,  is  acceptable.  Tne  overshoot  is  within  the 
design  specifications.  The  plane  angles  never  exceeded  the 
limits  and  the  pitch  is  small.  Small  gain  variations  led  to 
a  shift  in  the  trade-off  between  response  time  and 
overshoot.  The  improvements  which  resulted  from  tests  were 
not  significant  enough  to  justify  the  complexity  of  gain 
switching.  Thus  the  designed  compensator  will  cover  the 
entire  speed  range  from  9  to  15  kn  very  satisfactorily. 


Run  3 


The  7  kn  depth  response  exceeds  the  design  specifications 
slightly  kith  respect  to  time  and  overshoot,  while  pitch  and 
plane  angles  are  still  within  the  limits.  This  speed 
represents  a  borderline  case  where  the  compensator  might  be 
acceptable. 

*   Run  2  and  1  : 

For  these  two  speeds  the  overshoot  of  11.58  %  and  13.77  % 
respectively  exceed  the  specifications  by  far  and  the  times 
required    are    clearly    not    desired. 

It      was      possible      to      improve    the    response    time 
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with  gain  variations,  but  it  was  impossible  to  reduce  the 
overshoot  to  an  acceptable  value.  This  indicated  that  for 
slew  speeds  gain  switching  can  not  be  a  sufficient  measure 
to  adjust  this  compensator.  It  seems  that  a  redesign  of  the 
compensator  is  necessary. 

3  kn  and  5  kn  are  eliminated  from  further 
considerations  as  these  speeds  are  not  too  important  for 
submarine  maneuvering. 

c.   Modification  for  major  depth  changes 

The  mechanical  limit  for  both  rudder  deflections  is  35  °. 
As  outlined  in  the  design  specifications  these  limits  are 
reduced  to  smaller  values  for  higher  speeds.  Due  to  the 
linearity  of  the  system  major  depth  changes,  which  lead  to 
picportionai  depth  errors,  will  cause  plane  deflections 
exceeding  these  limits.  Therefore  it  is  necessary  to  prevent 
the  planes  from  exceeding  these  limits.  There  are  two 
possible  actions  one  can  take. 

First,  limit  the  planes.  Test  runs  where  this 
scheme  was  inplemented  led  to  unacceptable  plane  oehavior. 

Second,  limiting  of  the  error  signals.  The 
resultant  block  diagram  is: 
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From  the  design  specifications  it  was  determined  that  the 
error  limit  function  could  be  approximated  by  a  straight 
line : 

lim  =  -1.6655*0C  +  59.6875 

Where  UC  is  in  ft/s. 

This  function  and  the  resulting  maximum  angles  are  shown  in 
the  following  diagram 
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Table  13  shows  the  simulation  runs  for  100  ft  depth   change. 
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Figure  93  -   RUN  1 
100  FT  DEPTH  CHANGE,   7  KN 
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Figure  94  -   RON  2 
100  FT  DEPTH  CHANGE,   9  KN 
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Figure  95  -   RUN  3 
100  FT  DEPTH  CHANGE,  11  KN 
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Figure  96  -   RUN  4 
100  FT  D2PTH  CHANGE,  13  XN 
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Figure  97  -   RON  5 
100  FT  DEPTH  CHANGE,  15  KN 
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Figure  98  -   RUN  5 
100  FT  DEPTH  CHANGE,  15  KN 
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Figure  99  -   RUN  5 
100  FT  DEPTH  CHANGE,  15  O 
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After  an  initial  pitch  the  submarine  approaches  the  ordered 
depth  with  constant  plane  deflections.  Shortly  before  the 
depth  is  reached,  opposite  rudder  angles  ara  used  to 
eliminate  the  depth  rate. 

Although  it  takes  longer  to  reach  the  ordered 
depth  initially  the  overall  time  to  steady-state  decreases 
with  increasing  speed. 

This  completes  the  design  for  the  speed  range 
from  7  kn  to  15  kn  and  all  possible  depth  changes.  Froai  here 
on  the  behavior  of  the  compensated  non-linear  model  will  be 
investigated  under  special  conditions,  like  turns,  out  of 
trim  conditions, etc. 

The  final  blcck  diagram  and  the  DSL-Program  are  shown  in 
App.  D  . 
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C.   TOTAL  DECOUPLING 

The  previous  design  led  to  a  steady-state  decoupled  system, 
where  both  outputs  were  influenced  by  a  single  input  during 
the  dynamic  period.  In  our  case  the  pitch  encountered  was 
small.  In  order  to  keep  the  submarine  at  even  keel  for  zero 
pitch  input  at  all  times  the  system  has  to  be  totally 
decoupled.  One  method  to  achieve  this  behaviour  for  a 
multivar iable  system  will  be  analysed  and  applied  to  the 
linear  model. 

The  system  configuration  chosen  for  this  design  is: 
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The  closed  loop  system  can  be  represented  by 


which  can  be  combined  to,  as  will  be  shown: 


> 
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T   is  the  desired  overall  transfer  function  which  determines 
the  desired  overall  respones. 

Therefore 

T  =  PG 


thus 


-1 

G  =  F   T 


From  the  block  diagrams 


Y    =    10 


Y    =    rX 


X    =    CE 


E    =     0-FY 


Thus 


Y    =    FC[U-FY] 


or 


-1 


I    =    £1    4    PCF]       PCU 


and 


-1 

T    =    [I    +    PCF]       PC    =    PG 
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solving    for    compensator   C    results    in 


C    =    G[I    -    FT] 


-  1 


In  the  compensation  used  for  this  design  the   feedback   gain 
matrix  is  the  identity  matrix,  thus 


C  =  G[I-T] 


-1 


-1       -1 
=  E   T[I-T] 


Thus  the  ccmpensator  is  determined  by  the   plant,   which 
is  known,  and  the  desired  overall  transfer  function  T. 

In  order  to  determine  the   compensator   which   decouples 
th€  syst€a  at  all  times,  one  has  to: 

define  the  desired  response  according  to  the  system 
specifications.  This  determines  the  overall  transfer 
functicn  T. 

-1 

find  G    =   ?      T  and  check  for  realizabi lity . 

-1 

determine  C  =  G[  I  -  T] 

Applying  unity  feedback  and  using  casade  compensation  as 
outlined  the  blockdiagram  for  the  linear  model  becomes: 
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Figure  100  -   BLOCK  DIAGRAM 
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As  can  be  seen  from  the  block  diagram   the   requirements 
for  total  decoupling  can  be  stated  in  a  different  way. 


It  is  required  that 


and 


eg     =  -c   g 
11  p21      21  p22 


(26) 


eg     =  -c   g 
12  c1 1      22  p12 


(27) 


Single   loop   methods   can   be   applied   to   design   the 

compensators   c    and  c    to  guarantee  the  desired  response. 

1  1       22 

Once  c    and  c   are  determined  the  compensators  c    and  c 

11       22  12       21 

can  be  calculated  from  (26)  and  (27)  . 


-1 
As  Ref.  15   shows  C  is  realizable  if  G  and  [I  -  T]    are 

realizable.    A    rational    function   in   s   is   physically 

realizable  as  a  vcltage  transfer  function,  if  the   following 

conditions  are  met: 

the  coefficients  of  the  function  must  be  real. 

the  order  of  tne  numerator  must  be  less  or  equal 

to  the  order  of  the  denominator. 

there  are  no  poles  in  the  right  half  plane  and  poles 

on  the  imaginary  axis  must  be  simple. 

1 .   Cesi  cjn 

It  is  desired  that  the  transient  response  has  no  overshoot 
and  has  an  acceptable  rise  time.  The  following  transfer 
function  is  chosen  for  both  outputs 
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t   =  t 

1  1     22 


s  +<* 


t    =  t    =0,  because  the  system  is  to  be   decoupled 
12     21 


Following   the   previously   outlined   design   steps, 


-1 

P   *T  has  to  be  determined. 


The  plant  matrix  has  the  following  elements 


g     =  k   (zeros  g    )  /s  r~ 
c1  1     11         p11    fi 


g     =  k   (zeros  g    )/s;T 
p 12     12         p12 


g    =  k   (zeros  g    )  /  /- 
p21     21         p21  ° 


g     =  k   (zeros  g    )  /V 

p22     22  p22   o 


Thus 


-1 


k   (zeros  g    )  /t  -k   (zeros  g    )  /^ 
z.2                      p22   5      12         p12   ° 

-k   (zeros  g    ) //-  k   (zeros  g    l/.c, 

_21         p  2 1   3  11         pi  1   *  _ 


g   g    -  g   g 
p11  p22     p12  p21 


It  can  be  shewn  that 


g    g     -  g    g     =  1/s  f 
p 1  1  p22     p12  p21       ° 
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Therefore 


-1 


k       (zeros    g         )s         -k       (zeros   g         ) 
22  p22  12  p12 


-k       (zeros    g         ) s      k       (zeros    g         ) 
21  p21  11  p11 


P  P 

11  12 


P  P 

21  22 


and 


-1  2  2-1 

G    =     E       T    =    [  <*.       (S    ♦   c<)      ]P 


The  next  step  is  tc  find 


1-t        0 
22 


[I-T 


-1 


0      1-t 


1  1 


(1-t   )  (1-t   ) 
11      22 


(s+<<)  /s(s+2c*) 


(s+oO  /s(s+2d) 
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Finally    the    compensator    matrix   C    can    be   determined 


C    =    G[I-T] 


-1 


c  c 

11  12 


c  c 

21  22 


where 


c         =  oL    k       (zeros    g         )/(s  +  2d) 
11  22  p22 


c         »   -A  k       (zeros    g         )/s(s  +  2o0 
12  12  p12 


c         =    -  ck  k       (zeros    g         )/(s+2dL) 
21  21  p21 


c         =     d,    k       (zeros    g         )/s(s  +  2o() 
22  11  p11 


The  elements  of  the  compensator  for  this  specific 
design  consist  of  the  zeros  of  the  plant  transfer  function 
and  poles  which  depend  on  the  desired  response.  As  the  zeros 
of  the  plant  and  probably  the  time  constants  of  the  desired 
response  depend  on  the  speed  of  the  submarine,  it  can  be 
expected   that  the  compensator  is  highly  dependent  on  speed. 


The  realizability  of   C   is   guaranteed,   if   G   and 


-1 


[I  -  T]    are  realizable.  It  can  easily  be  seen  that  for  all 
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-1 

elements  of   G   and   [I  -  T]     all   three   above   mentioned 
conditions  are  satisfied. 

2.   Simulation 

In  order  to  check  the  design  the  system  was  simulated  for  a 
speed  of  S  ko.   The  choice  of  the  overall  transfer  function 


2        2 
t    =  t    =  .  2  /(s+.  2) 
11     22 


t    =  t    =  0 
12     21 


should  lead  to  an  overiamped  response,  which  reaches  the 
ordered  depth  in  about  60  sec.  From  Tables  06  -  10  and  the 
defined  overall  T  it  follows  : 


-1 
c    =  -.31945  10   (25.u52s+1)  /  (2.  5s+1) 
11 


c    =  -.  38194  (-5.  1921s+1)  ( 18  .  671s*  1 ) /s  (2  .  5s+1) 


-2 
c    =  .15017  10   (- 1  17.67s+1)  /  (2.5s+1) 
21 


-1 
c^   =-.29056  10   (5.6338s+1)  (131 .23s+1)/s (2. 5s+1) 


*  Unconstrained  trials: 

In   the   first   simulation   the   submarine  had  to  change  the 
depth  by  10  ft  at   even   keel.   The   simulation   showed   the 


172 


expected   response,  i.e.  the  depth  was  reached  after  50  sec. 

-5 
without  overshoot.  The  pitch  was  of  the  order  of  ±10   .  This 

deviation  can  be  explained  by  round-off  and  truncation. 

In  the  design  the  physical  constraints  on   the   planes   were 

neglected.   As  it  turned  out  these  constraints  were  exceeded 

by  far.  Due  to  the  step   input   of   the   ordered   depth   the 

fairwater   plane   angle   increased   initially   to   117°   and 

exceeded  the  limit  of  30°  for  about  4.5  sec.  The  max.   stern 

plane   angle   was  about  25°.   Obviously  further  compensation 

is  necessary. 

Another  important  aspect  is  the  sensitivity  w.r.t. 
speed.  Therefore  the  submarine  was  run  with  the  same 
compensator  for  7  and  11  kn. 

For  7  kn  the  depth  response  was  oscillatory  with  an 
overshoot   of  7.6%.  The  pitch  oscillated  with  a  amplitude  of 

10 

For  11  kn  the  depth  response  was  oscillatory  with  an 
overshoot  of  1%.  The  pitch  oscillated  with  an  amplitude  of 
.09°.  As  expected  the  system  is  no  longer  decoupled,  because 
the  "correct"  compensator  depends  among  others  on  the  zeros 
of  the  system,  which  in  turn  vary  with  speed.  As  the  depth 
response  deviates  significantly  from  the  desired  response 
with  change  in  speed,  it  can  be  concluded  that  the 
compensator,  designed  for  a  specific  speed,  covers  only  a 
relatively  snail  interval. 

*  I jplementation  of  constraints  : 

The  two  constraints  are  the  rate  limit  of  the  planes  and  the 
max.  angle  allowed  for  a  specific  speed.  The  rate  limit  is 
taken  care  of  by  the  actuator.  The  angle  can  be  kept  within 
its  limits  (ca.  30°  for  9  kn)  using  either  a  limit  on  the 
signal  applied  at  the  actuator  or  error  limitation.  For  a 
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Figure  101  -   TOTAL  DECOUPLING 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  102  -   TOTAL  DECOUPLING 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  103  -   TOTAL  DECOUPLING 
10  FT  DEPTH  CHANGE,  9  KN 
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Figure  104  -   TOTAL  DECOUPLING 
100  FT  DEPTH  CHANGE,  9  KN 
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Figure  105  -   TOTAL  DECOUPLING 
100  FT  DEPTH  CHANGE,  9  KN 
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Figure  106  -   TOTAL  DECOUPLING 
100  ?T  DEPTH  CHANGE,  9  KN 
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depth  change,  generally  the  required  fairwater  plane 
deflections  are  much  larger  than  the  stern  plane 
deflections.  As  soon  as  only  one  plane  limiter  is  saturated, 
the  achieved  decoupling  is  disturbed  as  can  be  seen  from 
Fig.  100.  This  saturation  occurs  for  a  small  depth  change  of 
only  3  ft.   Obviously  this  scheme  is  not  acceptable. 

The  error  limitation  eliminates  these  problems.  When 
the  depth  error  is  limited  to  2.5  ft.  the  initial  fairwater 
plane  angle  stays  within  the  specifications.  On  the  other 
hand  the  "steady-state"  angle  for  large  depth  changes  turned 
out  to  be  toe  small  (4.5°) ,  which  leads  to  an  unacceptaole 
response  time.  To  acnieve  both  an  acceptable  initial  and 
"steady-state"  angle,  the  limit  was  kept  at  2.5  ft  for  1.5 
sec  and  then  increased  to  a  final  value  of  12.5  ft  at  a 
constant  rate. 
The  limiting  function  used  is 


LIM  =2.5   ft 


t  <  1  .  5 


LIU    =    .2*  (TIHE-1 .5)  +2.5   ft 


1.5  <  t  <  53.5 


LIM  =  12.5   ft 


t  >  53.5 


The   final   block   diagram   and  the  OSL-Prcgram  are  given  in 
App  .  D 

Fig.  101  to  106  show  a  10  ft  and  100  ft  depth 
change.  In  tcth  cases  the  depth  response  is  overdamped  and 
satisfies  the  time  requirements.  The  pitch  is  decoupled  and 
the  submarine  remains  at  even  keel. 

It  has  been  shown  that  this  design  approach  has  the 
following  disadvantages: 

Speed   range   which   is   covered   by   individual 
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controller  is  very  small.  If  the  speed  deviates  too  much 
from  the  design  speed  the  system  is  no  longer  totally 
decoupled. 

Ihe  high  speed  dependence  requires  a  complex 
controller  with  varying  pole-zero  combina  t  icns  dependent  on 
the  speed  variations  (  system  dynamics  ). 

Additionally  the  "  Total  decoupling  scheme  "  is 
disturbed  by  the  non-linear  terms  in  the  ncn-linear  model, 
which  are  net  contained  in  the  linear  approximation. 
Therefore  this  design  approach  will  not  be  pursued  further. 
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V.   SIMULATION  OF  THE  COMPENSATED  NON-LINEAR  MODEL 


A.   MODIFICATIONS  FOR  NON-LINEAR  MODEL 

Ivo  of  the  linearizing  assumptions  were,  that   the   forward 
speed   is  constant  and  that  the  submarine  is  always  in  trim. 

The  purpose  of  this  chapter  is  to  investigate  the 
deviations  from  these  assumptions  and  their  influence  en  the 
behavior  cf  the  submarine  during  basic  maneuvers  like  depth 
changes,  turns,  and  turns  during  depth  changes. 
Generally  trim  is  a  moment,  but  it  is  commonly  used  in  a 
different  context  : 

-  "In  trim"  has  the  meaning  that  the  submarine  maintains 
depth  at  a  given  speed  with  the  desired  pitch  angle. 

-  "Out  of  trim"  conditions  are  heavy  or  light  forward, 
heavy  or  light  aft,  heavy  or  light  overall,  and  combinations 
of  these. 

-  "To  trim"  means  to  change  the  contents  of  the  tanks  by 
shifting  water  between  tanks,  flooding  tanks  from  sea,  or 
pumping  water  from  tanks  to  sea. 

The  arrangement  of  depth  control  or  auxiliary  and  trim  tanks 
in  the  assumed  submarine  are  such  that  any  change  in  the 
depth  ccntrcl  tank  does  not  produce  a  moment,  i.e.  the  depth 
control  tank  is  at  the  center  of  gravity.  The  trim  tanks  are 
arranged  as  shown  in  Fig.  107. 

1 .   Trim 

Frcm  experience  it  is  known  that  a  submarine,  which   is   in 
neutral  conditions  for  a  certain  speed,  "  gains  buoyancy" 
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Figure  107  -   CONFIGURATION  OF  TANKS 
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Figure  108  -   CORRECTIONS  FOR  TRIM 
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and  pitches  up  with  increasing  speed  and  vice  versa  due  to 
dynamic  forces  acting  on  the  hull,  and  therefore  is  no 
longer  in  trim  as  defined  above. 

Generally  a  submarine  should  be  in  trim  at  any  time 
for  a  given  commmand  speed  to  avoid  initial  plane 
deflections.  This  guarantees  availability  of  the  full  range 
of  the  planes  for  maneuvering.  Although  it  is  nearly 
impossible  tc  get  the  exact  trim,  it  certainly  is  helpful  to 
knew  the  corrections  for  different  speeds. 

Assuiiing  neutral  conditions  for  0  Jen  speed,  the 
corrections  for  trim  were  found  by  trial  and  error.  The 
values  shewn  in  Fig.  108  guarantee  an  approximately  neutral 
trim. 

The  results  confirmed  the  tendencies  observed  in 
practice . 

2«   Mechanical  constraints 

The  design  specifications  define  the  maximum  plane 
deflections  as  a  function  of  speed.  While  the  ordered 
revolutions  of  the  shaft  remain  constant,  the  actual  forward 
speed  (  in  direction  of.  the  x-axis  of  the  body-fixed 
coordinate  system)  decreases  during  maneuvers  due  tc  drag, 
which  is  produced  by  the  deflected  planes,  the  pitch,  the 
roll,  and  the  yaw. 

A  feedback  of  the  actual  forward  speed  U  instead  of 
the  ordered  speed  UC  modifies  the  error  limiter  to 

LIB  =  -1.6655*U  ♦  59.6375 

and  allows  the  use  of  the  maximum  plane  deflections  as  a 
function  of  the  actual  speed. 


185 


B.   TEST  BUNS 


For  the  test  runs  to  follow   the   designed   compensator, 
the   modified   limiter,   and  the  trim  values  for  the  ordered 
speed   according   to   Fig.  108   are    implemented    in    the 
noc-linear  mcdel. 
The  program  and  final  block  diagram  are  given  in  Ape.  D. 


1 •   JiC  ft  de£th  changes 

Table  14  lists  the  results  of  the  simulations  from 
7-15  kn.  Comparing  these  results  with  Table  13  it  is 
obvious  that  the  dynamic  oehavior  of  both  the  linear  and  the 
non-linear  mcdel  are  essentially  the  same. 

Due  to  the  initially  large  plane  deflections  the  speed 
decreases  by  more  than  1  kn  for  all  initially  ordered  speeds 
until  the  ordered  deptn  is  reached.  At  this  time  the  plane 
deflections  get  small  and  the  submarine  accelerates  to  the 
original  speed.  As  predicted,  the  initial  plane  angles  are 
increased  with  decreasing  speed. 

Although  the  reduced  speeds  cause  slightly  increased 
overshoots,  the  designed  controller  is  still  able  to  satisfy 
ail  tne  design  specifications. 

2 .   Turns 

One  cf  the  more  difficult  maneuvers  with  a  submarine 
is  to  change  the  depth  and  the  course  simultaneously.  It  is 
of  interest  to  studv  the  behavior  of  the  submarine  in  a  turn 
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first  without  depth  change,  because  the  flow  dynamics  in  a 
turn  change  significantly. 

The  transverse  motion  of  the  submarine  causes  cross  flow 
velocities.  If  the  submarine  had  no  appendices  this 
crossflow  would  produce  no  pitch  or  other  forcing  moment  on 
the  hull.  But  due  to  the  conning  tower  and  ether  appendices 
the  flew  ever  the  upper  portion  of  the  hull  slows  dewn.  A 
wake  shed  frcm  the  conning  tower  also  effects  the  velocity 
distribution  aft. 
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Figure  109  -   RUN  1 
100  FT  DEPTH  CHANGE,   7  KM 
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Figure  110  -   RUN  1 
100  FT  DEPTH  CHANGE,   7  KN 
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Figure  111  -   RON  1 
100  FT  DEPTH  CHANGZ,   7  KN 


191 


z 


caeS 
W 

H 


w 

o 


si:  ■ 


TIME  -  80  SEC  PER  INCH 


Figure  112  -   RUN  2 
100  FT  DEPTH  CHANGE,   9  KN 
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Figure  113  -   RON  2 
100  FT  DEPTH  CHANGE,   9  KN 
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Figure    114    -      RUN    2 
100    PT    DEPTH    CHANGE,       9    KN 
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Figure  115  -   RON  3 
100  FT  DEPTH  CHANGE,  11  KN 
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Figure  116  -   RUN  3 
100  FT  DEPTH  CHANGE,  11  KN 
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Figure    117    -      RUN   3 
100    FT    DEPTH    CHANGE,     11     KN 
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Figure  118  -   RUN  4 
100  FT  DEPTH  CHANGE,  13  KN 
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Figure  119  -   RUN  U 
100  FT  DEPTH  CHANGE,  13  KN 
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Figure  120  -   RUN  <4 
100  FT  D2PTH  CHANGE,  13  KN 
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Figure    121    -      RUN    5 
100    FT    DEPTH    CHANGE,     15    KN 
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Figure  122  -   RUN  5 
100  FT  DEPTH  CHANGE,  15  KN 
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Figure  123  -   RUN  5 
100  FT  DEPTH  CHANGE,  15  KN 
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submarines  the  performance  of  the  controller  even   for   hard 
turns  is  very  satisfactory. 

After  toth  maneuvers  have  oeen  studied  independently 
the  combination  of  them  leads  to  Fig.  136-141  and  Table  16. 
It  is  obvious  that  both  parts  of  the  combined  maneuver 
influence  each  other.  The  time  required  to  reach  the  ordered 
depth  increased  with  increasing  rudder  angle.  At  the  same 
time  the  yaw-angle  reached  after  400  s  decreased  by  about 
20°  compared  to  a  turn  without  depth  change.  The  overshoot 
experienced   stayed   still  within  the  design  specifications. 

Table  16  -  Course  and  depth  change  of  100  ft 


Rudder 
angle 
in  ° 

Depth 
reached 
in  sec 

Max 
pitch 
in  ° 

Overshoot 

in  ft 

Max  speed 

deviation 

in  kn 

Yaw 
in  ° 

10 
20 
30 

96 

1.  54 
2.51 
3.27 

2.97 
3.  32 
4.77 

2.08 
2.94 
3.  91 

70.  7 
102.  8 
120.  3 

3 •   Cut  cf  trim  conditions 

All  test  runs  performed  indicated  that  the  speed  was 
reduced  due  to  additional  drag  introduced  by  all  maneuvers. 
From  Fig.  1C8  one  must  conclude  that  the  submarine  is  not 
in  trim  during  maneuvers.  This  out  of  trim  condtion  has 
clearly  an  effect  on  the  performance  of  the"  submarine.  3ut 
as  the  controller  is  capable  of  handling  these  deviations  it 
is  not  advisable  to  try  to  trim  the  boat  temporarily  during 
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Figure  124  -   COURSE  CHANGE,  HORIZONTAL  PLANE 
RODDER  ANGLE  =  10°,  SPEED  =  11  KN 
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Figure  125  -   COURSE  CHANGE 
RUDDER  ANGLE  =  10°,  SPEED  =  11  O 
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Figure  126  -   COURSE  CHANGE 
RODDER  ANGLE  =  10°,  SPEED  =  11  KN 
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Figure  127  -   COURSE  CHANGE 
RUDDER  ANGLE  =  10°,  SPEED  =  11  KN 
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Figure  128  -   COURSE  CHANGE,  HORIZONTAL  PLANE 
RODDER  ANGLE  =  20°,  SPEED  =  11  KN 
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Figure  129  -   COURSE  CHANGE 
RODDER  ANGLE  =  20°,  SPEED  =  11  KN 
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Figure  130  -   COURSE  CHANGE 
RUDDER  ANGLE  =  20°,  SPEED  =  1  1  KN 
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Figure  131  -   COURSE  CHANGE 
RUDDER  ANGLE  =  20°,  SPEED  =  11  KN 
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Figure  132  -   COURSE  CHANGE,  HORIZONTAL  PLANS 
RUDDER  ANGLE  =  30°,  SPEED  =  11  KN 
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Figure  133  -   COURSE  CHANGE 
RODDER  ANGLE  =  30°,  SPEED  =  1 1  KN 
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Figure  134  -   COURSE  CHANGE 
RUDDER  ANGLE  =  30°,  SPEED  =  11  KN 
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Figure  135  -   COORSE  CHANGE 
RODDER  ANGLE  =  30°,  SPEED  =  11  KN 
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Figure  136  -   COURSE  AND  100  FT  DEPTH  CHANGE 
RUDDER  ANGLE  =  10°,  SPEED  =  11  KN 
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Figure  137  -   C00RSE  AND  100  FT  DEPTH  CHANGE 
RODDER  ANGLE  =  10°,  SPEED  =  11  KN 
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Figure  138  -   COURSE  AND  100  FT  DEPTH  CHANGE 
RODDER  ANGLE  =  20°,  SPEED  =  11  KN 
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Figure  139  -   COURSE  AND  100  FT  DEPTH  CHANGE 
RUDDER  ANGLE  =  20°,  SPEED  =  11  KN 
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Figure    140    -      COORSS    AND    100    FT    DEPTH    CHANGE 
RODDER    ANGLE    =    30°,    SPEED    =     11    KN 
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Figure  141  -   COURSE  AND  100  FT  DEPTH  CHANGE 
RODDER  ANGLE  =  30°,  SPEED  =  11  KN 
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maneuvers. 

Tc  demonstrate  the  influence  of  the  out  of  trim  conditions 
100  ft  depth  changes  were  simulated.  First,  the  correct 
forward  and  aft  trim  for  the  ordered  speed  of  11  kn  was 
maintained  vihile  the  submarine  was  too  heavy  or  too  light 
overall.  Second,  the  correct  overall  weight  was  used  and 
forward  and  aft  trim  changed  by  the  same  amount,  but 
opposite  in  sign. 

Tafcle  17  -  Incorrect  overall  weight 


Height 
error 
in  lbs 

Eepth 
reached 

in  sec 

^ — 

overshoot 

in  ft 

i 1 

Steady-state  error  in 

pitch 
in  ° 

depth 
in  ft 

+  2000 
♦  1000 
0 
-1000 
-2000 

64. o 

65.0 
66.0 
67.5 

89.0 

3.72 
3.41 
3.  10 
2.76 
2.45 

0.035 

0.018 

0.000 

-0.018 

-0.037 

C.440 

0.210 

0.000 

-0.315 

-0.516 

Tables  17  and  18  show  the  influence  of  trim  changes.  A 
change  in  the  overall  weight  of  2000  lb  and  a  transfer  of 
800  lb  frcm  the  aft  to  the  forward  trim  tank  cr  vice  versa 
is  required  for  the  adjacent  2  kn  intervals.  The  overshoot 
behaves  as  expected,  i.e.  when  the  boat  is  too  heavy  overall 
or  the  bow  is  too  heavy  the  overshoot  increases.  Vice  versa 
the  overshoot  decreases  when  the  submarine  is  too  light. 
During  all  maneuvers  the  speed  decreases,  which  causes 
according  tc  Fig.  108  too  heavy  overall  and  too  heavy 
forward  conditions.  This  explains  the  increased  overshoot 
observed  for  the  depth  changes  simulated  before. 
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Table  18  -  Incorrect  forward  trim 


Forward 
trim 
in  lbs 

Eepth 
reached 
in  sec 

overshoot 
in  ft 

Steady-state  error  in 

pitch 
in  ° 

depth 
in  ft 

+  800 

63.0 

4.  17 

-0.067 

0.790 

+  400 

65.0 

3.63 

-0.034 

0.380 

0 

66.0 

3.  10 

0.000 

0.000 

-400 

87.0 

2.56 

0.034 

-0.434 

-800 

90.0 

2.00 

0.067 

-0.840 

A  new  feature  experienced  during  these  trials  is  a 
steady-state  error  in  depth  as  well  as  in  pitch  after  the 
submarine  has  regained  its  original  ordered  speed.  These 
steady-stat€  errrors  are  small  for  relatively  great  cut  of 
trim  conditions  as  2000  lb  in  overall  weight  and  800  lb 
heavy  fcrwaid.  If  the  disturbances  become  greater  it  is 
clearly  necessary  to  prevent  these  steady-state  errors. 
There  are  basically  two  alternatives.  First,  correct  the 
trim.  Seccnd,  increase  the  sensitivity,  i.e.  the  gains  of 
the  compensator  for  small  depth  and  pitch  errors. 
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VI .   CONCLUSIONS 

The  system  under  investigation  was  a  mul tivariable 
non-linear  system  with  six  degrees  of  freedom.  Linearizing 
assumptions  decoupled  the  vertical  plane,  now  a 
two-dimensional  multivariable  linear  system.  Comparative 
test  runs  cf  the  open-loop  linear  and  non-linear  model 
justified  the  utilization  of  the  linear  model  for  the 
design.  Ihe  cbjective  was  to  design  a  depth  controller  with 
a  limited  number  of  feedback  states.  Two  approaches  using 
cascaded  transfer  function  matrices  were  investigated. 


A.   STEADi-SIATE  DECOUPLING 

It   has   teen  shown  that  the  steady-state  decoupling  scheme 
can  be  successfully  applied  to  this  submarine  problem. 

Using  output  feedback,  steady-state  decoupling  depends 
only  on  the  pure  integrators  the  number  of  which  is  easy  to 
determine  by  applying  the  final  value  theorem.  But  the 
actual  design  of  the  compensator  is  a  matter  of  trial  and 
error.  Although  single  loop  techniques,  here  the  root-locus 
design,  can  be  applied  systematically,  it  still  is  a 
laborious  and  iterative  process  which  requires  either 
experience  cr  many  trials. 

Design  fcr  stability  and  desired  dominant  roots  was 
possible,  but  only  simulation  verified  the  dominance 
assumption.  As  the  desired  characteristics  fixed  the  gain  of 
the  compensator  matrix  larger  depth  changes  led  to  excessive 
plane  deflections.  Therefore  limiters  were  required  tc  keep 
the  planes  within  the  physical  constraints. 
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The  ccntrcller,  designed  on  the  basis  of  the  linear 
model  dynamics  for  9  kn,  showed  the  following  performance, 
when  implemented  in  the  non-linear  model: 

a.)   The  design  specifications  for  a  speed  range  from 
7  -  15  kn  were  satisfied. 

b.)   Out  cf  trim  conditions  led  to  small  steady-state 
errct  s . 

c.)   When  operated  in  depth  keeping  mode  in  a  turn  the 
ccntrcller  performed  satisfactorily. 

The  compensated  system  is  rather  insensitive  to  speed. 
Thus  all  pictlems  related  to  gain  switching,  like  chattering 
and  discontinuities  in  command  plane  angles,  are  avcidei. 
This  is  especially  important  because  the  speed  changes 
significantly  during  maneuvers. 

The  design  was  only  concerned  with  the  derivation  cf  the 
transfer  functions  for  the  cascaded  compensator.  When 
implemented  in  hardware  it  has  the  following  desiraDle 
f ea  tures  : 

*  Minimal  instrumentation 

As  no  rate  information  is  required  only  simple  sensors  for 
depth  and  pitch  angle  are  necessary,  i.e.  no  inertial 
guidance  system. 

*  Low  cost,  weight,  and  size 

The  simplicity  of  the  compensator  transfer  functions  makes 
them  easily  realizable  in  physical  hardware  at  low 
manufacturing  cost.  Weight  and  size  requirements  are  very 
small,  anctker  important  factor  especially  for  small  coastal 
sue  marines. 

*  Reliability 

The  automatic  controller  can  be  realized  with  a  set  of 
physical  components  with  a  well  known  high  reliability.  High 
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component  reliability  and  a  small  number  of  components   will 
generally  result  in  a  high  system  reliability. 


E.   TOTAL  DECOUPLING 

As  for  the  steady-state  decoupling  scheme  the  total 
decoupling  is  based  on  the  linear  model.  The  determination 
of  the  compensator  matrix  is  an  easy  mathematical  process, 
once  the  desired  response  dynamics  have  been  defined  in  form 
of  an  overall  transfer  function  matrix.  At  the  first  glance 
this  method  seems  to  be  very  appealing  but  it  has  some 
limitations : 

a.)   The  realizability  of  the  compensator  is  not  always 

guaranteed,  as  the  poles  and  zeros  of  the  compensator 
matrix  among  others  are  determined  by  the  plant 
singularities. 

b.)   Changes  in  the  plant  dynamics  require  changes  in  the 
compensator  matrix. 

The  realizability  of  the  compensator  was  no  problem  for 
the  system  under  investigation.  The  second  limitation 
presented  serious  problems.  As  the  system  dynamics  change 
with  speed,  the  compensator  theoretically  covers  only  a 
specific  Sfeed.  Test  runs  showed  that  a  compensator 
calculated  fcr  one  speed  was  capable  of  covering  a  very 
small  speed  interval.  In  order  to  cover  a  large  speed  range 
as  required  in  our  problem  the  compensator  has  to  be  very 
complex  because  the  gain  and  the  root-locations  have  to  be 
adjusted  in  very  small  step  sizes.  The  influence  of 
ncr-linearities  was  not  considered  as  these  will  disturb  the 
total  decoupling  scheme  even  more. 

As  result  of  this  investigation  it  is  concluded  that  the 
total  decoupling  scheme   seems   not   to   be   practical.   The 
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cascade  compensation,  using  the  steady-state  decoupling 
method,  is  pcssibie  and  practical  for  automatic  pitch  and 
depth  contrcl  cf  small  submarines. 
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APPENDIX  A 


STANDARD  EQUATIONS  OF  MOTION 


A.   AXIAL  FOECE 


m(u  -vrlwq)-    |  |«     [X  qq    '  q2  ♦  Xrr  •   r2  ♦  X  pp    '  rp] 

+    !  *     [X  u     '  fi  +  X  vr     '  vr  +  X  wq    '  "*] 
+   f/2    [Xuu     'u2+Xw    'v2+Xww     '^] 

2  L      6r6r        Qr  ^  6s6«  s  6b6b        fib  J 

+   f  r2  X  ,     •   (n'   -    I)  v2 

Z  vvn'  ' 


+  T^Xwwn'     'W-    Hw2 


+  fzV  x  <  (n«  .  i)  a  * 


+   fiVX*    a       ,     '   (n'   -    1)  6    J 

'  ar6rn'  r 


-     LW.   sin  9 

i 


+     <Fx>P 
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B.        LATEBAL    FOECE 


m(v  -wp  +  ur)=    JV     [Y  j    '   *  *   Y  '    '  P  ] 

♦f'4   [YPq  '«♦  YP|p|    'pIpI] 


+  f     [Y.     'W  Ywp    'wP+  Yv|r|   v    |(v»  +  w^|    |P|] 


|  J"     [Yr    'ur+Y|r|6r    'u|r|<r+Y        'up] 


+  £*3    YrQl     '  tn«  -    1)  ur 


*£/2    |"Y  ,    •  u: 


♦  Yv|v|     '  v[(v2+  w2)*|] 


2  6r  r 


+  fiVY6rn'     ,(n'-l)6r 


+  f  Z2  Y        ,     '   (n'   -    1)  u^ 
2  vn'  ' 


+  f/2  Yv|v|n>     '   (n'   -    »>v|<V*  +   w2)*[ 


+  f  ll      Y  l  wv# 


+  -?  Z2  (F    )  v2  +  w* 

2  y     V3 


U 


+  EWj  sin$  cos  0 


(-w)     Sin. out 


9  Multiplied  by 


u 
U 


for  large  .ingles  of 
attack  near   -90° 
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C.        NCBMAL    FCECE 


m(w-uq+   vp)=    £i«    Z    .     'q 


Note    1 


♦f<4     [Zrr    ,r^  +  Zrp    '  «*'] 

,^[Zw'^Zvr     'vr'  +  Zvp     'VP+iZvp    'VP#] 

+    |Z3     TZ         'uq+Z,     ,.        »«|q|4.*Z       ,     ,  *  2f  I  (  v*  ♦  w2  >*  |   |q(] 

2        L    q  I  q  U 8  w  I  q  I  [w[ 

+   -Pi3     Z        ,     '  (n«   -    1)  uq 
I  qn 

t  |,»   [z,    'U1*Zw    '«w  +  Zw|w|    'wK*1  +w')J|] 
♦  flV   [2S,    •»•  +  *,„    '«>] 


+   f<VZ6.„.     '(»•-»«. 


+   -9  L*  (F    )  v2   +  w2  v    Sin  ujt 

l  I     vs      g 


+    BW.   cos  9  cos  *)  H   Multiplied  by 

u 

for  large  angles  of 
attack  near  -90° 

Note   1 
when  not  multiplied  by 
u    add  to  Z      ' 

v  vp 
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D.       ROLLING    tfCMENT 


I 


^♦a.-yv  -p<  [*p  'p>%r  'v**i  'r  +  Kplp|  lp|p|-j 

♦  |  **     [K  p    '  up  +  K  r    '  ur  ♦  K  .     '  v  ♦  K  ^    '  wp] 


+  ^l3     K  '  vw 

2  vw 


♦!''"'K4r    '4, 


+     Bz  R     ein  $    cos  8 


B 
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E.   PITCHING  MOMENT 


Note   I 


V  +  °x  "  y  rp    -   I1"     LM  q    '^Mrr    '  r'»  +  M  rp    '  rP  +  ^M  rp    '  'P»] 

♦  £**     [Mq    'uq+M|q|63     '  «|q|«.  f  M  |w(q    >   |(v«*    w^|q] 

♦  -£**     [m    .     '  w+M  •  vrl  +  M  »  vpll 
*Lw                      vr                          vpj 


♦  ~  I*  M 


frMqn'       (n'  "  I)u<* 
*fi3    [M,    'u2+Mw    •«w+Mw|w|     »w|<v»+w*)*|] 


*f'3 


[m|w|'u|w[  +Mww     |w(v**w*)*|  f  Mvv«v»f] 


+   f^     u2    [M6s     '6a  +  M6b    ,fib] 


+  l/3   Mwn'     '  (n'  *   1)uw 


+   l/3   Mw|w|n'     '<«'   "    »>w|(v'  +  w*,*| 


+   -f  *3   u2  M   .       ,     •  (n»  -   I)  6 

t  6sn'  i 


+     Bz        sin  0 


-     EW  t  xt.  cos  0  cos  $ 


0  Multiply  by    .T  for 
large  angles  ofattack 
near  -90" 

Note   1 
when  not  multiplied 
by    **  add  to  M      ' 
U  rP 
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F.   YAWING  MCMSNT 


x  y 


♦  |,«    [Mf    'ur  +  N[rl6r    .u|r|«r*N|v|rM(v**w»)^|r] 

+  |i*     [N        '  uP+  N.     '  *♦  Nwp    »wp] 


+  _Pl*     N       ,     '  (n'   -   1)  ur 
Z  rn 


♦  |  X3     [N  ,    '  u*  *   N  y    '  uv+   N 


v   v 


«V**W*)*    |] 


+  f'3     u'N6r    '6r 


+  f'3     "2*6rn'     ,(n'   "    U6r 


+  £i3    N      ,   •  (n*  -  l)uv 

Z  vn' 


+  f<3    Nvlv|n' 


(n1    -    1)  v|(v2  +w2)h 


Z  wv 


+    J)\V.    x  .    cos  8   sin  $ 


i  Multiply  by   -   for  large 
angles  of  attack  near   -90° 
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G.       AOXIIIAHY    EQUATIONS 

<{)         =        p  +  i  sin8 

8         =        (q    -    i)cosd  sin(J)  )  /  co  s  <J> 

i>         =        (  r   +  8  sin<J>  )   /  cos  8co»4> 

Xo       =        ucoa0cos>)  +  v(sin<t)3in8co3^-cos9sinii») 
♦  w  (  ein<J)   sin  ij)  +  cos({)   sin8  co$<i) 

y0      ■        ucos8sin#  +  v(cos<{)cosi£  +  sin4>sin8sinC>) 
4  w  (  cos<£>  sin  8  sin  #   -   sin(J)cojij;) 

z0      =        -  u  sin8  +  v  cos8  sinQ   +  w  cos9  cos  9 

U         =         (u3    +  v3   +  w2)^ 

=       ^  X2  u2  [  fcV  +  iv,'  n'   t  b3'  n'2  1  when      k,   <    n'  <   kx 

=        |  L1  u2  [  cx'  +  c,'  n'   +  c3'  n'2  1  when      k3   <    n'  <    kg 

|  il  u2  [  d,'   +  d?'  n'   +  da'  n'2  1  when      n'  <   k;, 


•         •  i 

«1.f    a2»  a3 

i-        i  i 

b)i    t>2,  b.  Sets   of   non-d  Ivor's  lot. al    coefficients   'iscd   In   the   pro- 

,         ,  pulsion  equation  Above •      The   set  vhlch  will   be    In  effect 

cl*   c2>  c3  Qt  Qny   tlse  d.irlr.,*  a  slmlatcJ  sar.ewver  vlll    depend  on  the 


t         i         ■ 

di,   d2,   d3 


value  of  n     ar-.d   the  nar.be rs   k.,v.-,k   . 
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APPfNDIX  B 


NOMENCLATURE 


SYMBOL 


DEFINITION 


A  dot  over  any  symbol  signi- 
fies differentiation  with  res- 
pect to  tloe. 

Buoyancy  force  which  is  posi- 
tive upwards . 

Mass  of  the  submarine  Including 
the  water  in  the  free  noo<t<ng 
spaces. 

Overall  length  of  the  submarine 

Linear  velocity  of  origin  of 
body  axes  relative  to  an  earth- 
fixed  axis  system. 

Component  of  U  along  the  body 
x-axls . 

Component  of  U  along  the  body 

y-ax  Is . 

■ 

Component  of  U  along  the  body 
z-axl s . 
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Command  speed:   A  steady  vnlue 
of  u  for  a  given  propeller  rpm 
whence, &  and  control  surface 
angles  are  zero.   Sign  changes 
with  propeller  reversal. 

Longitudinal  axis  of  the  body 
fixed  coordinate  axis  system. 

Transverse  axis  of  the  body 
fixed  coordinate  axis  system. 

Vertical  axis  of  the  body  fixed 
coordinate  axis  system. 

Distance  along  Che  xQ    axis  of  an 
earth-fixed  axis  system. 


Distance  along  the  yQ  axis  of  an 


car 


th-flxed  axis  system 


Dl8tancc  along  the  zq    axis  of  an 
earth-fixed  axis  system. 

Component  of  angular  velocity 
about  the  body  fixed  x-axls. 

Component  of  angular  velocity 
about  the  body  fixed  y-axls. 

Component  of  angular  velocity 
about  the  body  fixed  z-axis. 

The  z  coordinate  of  the  center 
of  buoyance  (C3)  of  the  subma- 
rine. 
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Ang  lc  of  attack. 


(3 

Sb, 

Db 

Sr, 

Dr 

Ss, 

D3 

An^le  of  drift. 

Deflection  of  bowplane  (  or 
sailplane  ) 

Deflection  of  rudder. 

Deflection  of  sternplane. 


The  ratio  u  /u, 


e 
C 


Pitch  angle. 

7 iv  angle . 

Rol 1  ang  le . 

Mass  density  of  sea  water. 

Weight  of  vjter  blown  fron  a 
particular  ballast  tank  ldent' 
lfled  by  the  Integer  assigned 
to  the  Index  1 . 


O) 


Angular    velocity 


Time. 


tl 


Location  along  tho  body  x-axls 
of  the  center  of  mass  of  thp  1 c" 

balfast  tank  when  this  tank  Is 
filled  with  sen  water. 
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(vP 


Propulsion  force  (see  auxi- 
liary equations  and  relation 
ships). 


Moment  of  Inertia  of  a  sub- 
marine about  the  x-axls. 

Monent  of  Inertia  of  a  sub- 
marine about  the  y-axls. 

Moment  of  Inertia  of  a  sub- 
marine about  the  z-axls. 


K  • '     K    '      if  '    v       i 

P*       P'    KP|p|   'Kqr» 

K    '      K . '     r  • '     r      '      i.     ' 
r'       i'    Kv    kup.    **• 

KV    Kv  jvj  .     Kvw,    K^r' 


Non-dlnens 1  on j 1  constants  each 
of  which  Is  assigned  to  a  parti- 
cular force  tern  In  the  equation 
of  motion  about  the  body  x-axls. 


q     rr     rp       rp     q    t  q  J  6a  ' 

Mi  j   ,  M.',  M   ',  H   »,  H   ',  M  '      Non-dimensional  constants  each 
I w I q    w     vr     vp     qn      ■ 

of  which  Is  assigned  to  a  partl- 

M  ',  M  I   |,  Mi   i*.  M   ',  M   *,  M.  ',  cular  force  tern  in  the  equation 
v     v|w|     |w|     uu  '   vv     6s 

of  motion  about  the  body  y-axls. 


M   '  ,  M   ,  •  ,  M  I   |  ,  '  ,  M 

6b  '   wn   '   vl win 


'6sn' 
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■»'■  V-  V-  V-  Vi«,'-  sm 


d  '  Sv  '   wp  •   rn'  '  **  '   v  ' 


Non- d 1 ne ns Ion  a  1  constants  each 
of  which  Is  assigned  Co  a  parti- 
cular force  tern  In  Che  equation 
Nv|v|''  "tfr"1  N5rn'   '  Svn*   '  Sv|v|n'   'of  motion  about  Che  body  r-axl«. 

wv 


X   *  .  X   '.X   '  ,  X.  '  ,  X   ',X   ', 

qq  '   rr     rp     u     vr     wq 


Xuu''  "vv''  Xww''  X6T6r''    X5  so  8 ' 


A6b6b     '       vvn    '       wwn'      '       isisn'     ' 


Non-dlr, ens  tonal  eonatanti  each 
of  which  Is  assigned  to  a  parti- 
cular force  tern  In  the  equation 
of  notion  along  the  body  x-axlj. 


X6rom'' 


V •    **/•    *       ' •    T.l.l •    *•*.    Y       '  , 


v    r 


p         pq 

'.    Y     ',    Y 


P!  P 


wp 


,       „     ,  ,       Non-d inens I  on j 1    constants    each 

_|x_   •   »     ,   T    t   , 

1        ?  of  which  is  assigned  to  a  parti 


T*    '     Yv     •    Yv|v|     •    Y6r     '    Y3rn« 


Yvn''*  Yv|  v|n'  ''  Ywv'  '  (?/K3 


cular  force  Cera  in  the  cquatlo 
of  notion  along  the  body  y-axis 


V'  Zrr''  Zrp'  '  Zw '  '  Zvr'  Zvp'  ' 

AZvp''  V'  Z|q|6s'  Zw|q|'' 

qn  '   *'   v*   w|w|      |W| 

Z    •  Z    ,  Z.   ,  Z . ,   ,  Z   i  > 
w      vv      5s      oo     wn 


VI  v  n 


isn 


Non- d inens i ona 1  constants  each 
of  which  is  assigned  Co  a  parti- 
cular fore  tern  in  chc  equatio- 
of  nocion  along  the  body  z-axls 


z  vs 


2U1 


APPENDIX    C 


HYDEOEYNAMIC    COEFFICIENTS    OF    SIMULATION    MODEL 
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APPENDIX  D 


DSL-PROGRAMS  AND  BLOCK  DIAGRAMS 


COMPENSATED  LINEAR  MODEL 
(STEADY-STATE  DECOUPLING) 


COMPENSATED  LINEAR  MODEL 
(TOTAL  DECOUPLING) 


COMPENSATED    NON-LINEAR    MODEL 
(STEADY-STATE     DECOUPLING) 
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